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ABSTRACT 


Many  apparel  manufacturing  operations  involve  the  han¬ 
dling  of  multiple-ply  workpieces.  Previous  efforts  at  auto¬ 
mating  apparel  handling  operations  has  concentrated  on  planar 
fabric  handling  operations  of  single-ply  workpieces.  Spe¬ 
cialized  end-effectors  are  needed  to  handle  and  manipulate 
flexible  multiple-ply  assemblies  in  three  dimensional  space. 
This  requirement  has  been  addressed  by  (1)  developing  con¬ 
cepts  for  three  dimensional  manipulation  of  multiple-ply 
apparel  workpieces,  and  (2)  designing  and  evaluating  an  end- 
effector  for  demonstration  of  these  concepts. 

The  end-effector  design  concepts  have  been  developed  by 
observing  the  manual  handling  of  a  shirt  collar.  The  end- 
effector  grasps  and  manipulates  a  single  workpiece  using  two 
parallel  jaw  grippers.  The  individual  plies  of  the  workpiece 
are  separated  from  one  another  by  gravitational  force.  The 
location  of  the  grippers  are  varied  so  that  the  fabric  ply 
can  be  stretched.  Stretching  the  grasped  ply  enables  the 
end-effector  to  control  fabric  drape  at  the  workpiece  edges. 
The  orientation  of  the  grippers  can  be  changed  by  a  pitch 
motion  on  the  end-effector. 

The  gripper  translation  motion  has  been  designed  to 
minimize  interferences  with  the  robot  workspace.  The  pitch 
motion  employs  a  novel  design  concept  to  reduce  the  peak 
torque  required  by  the  motor  driver.  The  design  uses  the 
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end-effector  motors  to  counterbalance  the  weight  of  the 
remainder  of  the  end-effector  while  undergoing  the  pitch 
motion. 

A  step  motor  actuates  the  translation  motion  of  the 
grippers.  The  velocity  and  acceleration  parameters  of  the 
step  motor  have  been  determined  by  an  experimental  procedure. 
The  end-effector  pitch  motion  is  actuated  by  a  DC  servo 
motor.  The  controller  gains  for  the  closed  loop  pitch  motion 
control  system  have  been  analytically  determined.  Experimen¬ 
tal  trials  conducted  with  the  end-effector  show  that  the  ana¬ 
lytical  predictions  of  the  pitch  motion  performance  are  valid 
in  the  linear  range  of  the  motor  drive.  Non-linearities 
present  in  the  system  such  as  actuator  saturation  and  gearbox 
backlash  need  to  be  considered  to  more  accurately  predict  the 
analytical  dynamic  behavior  of  the  system. 

The  end-effector  has  been  integrated  into  a  workstation 
that  processes  shirt  collars  without  human  intervention. 
Collar  handling  demonstrations  show  that  the  end-effector  is 
capable  of  handling  a  multiple-ply  apparel  component  in  three 
dimensional  space.  Future  research  should  include  improve¬ 
ments  in  mechanical  design  and  refinements  in  analysis  tech¬ 
niques. 
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CHAPTER  I 


INTRODUCTION 

Robotic  handling  of  apparel  components  is  being  inves¬ 
tigated  to  improve  the  productivity  of  apparel  manufacturing 
operations  and  hence  make  the  domestic  apparel  industry  more 
competitive.  Past  research  efforts  have  mainly  concentrated 
on  developing  robot  systems  for  handling  single  ply  fabric 
panels.  However,  there  exist  numerous  operations  involving 
the  three  dimensional  manipulation  of  multiple-ply  apparel 
components.  Such  operations  are  currently  performed  manually 
requiring  a  high  degree  of  operator  dexterity.  Few  attempts 
have  been  made  at  automating  three  dimensional  manipulation 
operations.  The  topic  of  the  current  research  is  to  develop 
an  end-effector  for  the  three  dimensional  manipulation  of 
multiple-ply  apparel  components.  An  example  of  a  multiple- 
ply  apparel  component  that  assumes  a  three  dimensional  shape 
while  undergoing  processing  is  the  shirt  collar.  The  design 
concepts  developed  in  this  research  will  be  demonstrated  for 
the  robotic  manipulation  of  shirt  collars. 

This  chapter  provides  a  background  to  the  apparel  ma¬ 
nipulation  problem  and  identifies  the  objectives  of  the 
research.  A  survey  of  previous  work  documenting  the  develop¬ 
ment  of  end-effectors  is  presented,  with  special  reference  to 
apparel  handling  manipulators.  The  chapter  concludes  with  a 
brief  summary  of  the  thesis  format. 
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Background 

Automation  of  Apparel  Manufacturing  Operations 

Due  principally  to  high  labor  costs,  the  apparel  indus¬ 
try  in  the  United  States  is  finding  it  difficult  to  compete 
with  foreign  manufacturers.  Continual  fashion  changes  from 
season  to  season  have  increased  the  pressure  on  apparel  manu¬ 
facturers  to  respond  more  rapidly  to  market  demands .  Re¬ 
search  efforts  have  been  initiated  in  the  United  States, 
Japan,  and  Western  Europe  to  automate  many  of  the  operations 
in  apparel  manufacturing  to  reduce  production  costs  and 
turn-around  times. 

Apparel  manufacturing  operations  can  be  classified  into 
two  broad  categories  ,  namely  joining  and  handling.  Joining 
operations  include  sewing,  and  adhesive  and  ultrasonic  bond¬ 
ing.  Handling  operations  consist  of  ply  separation,  pick- 
and-place,  folding,  guiding  fabric  panels  during  joining 
operations,  and  inversion  of  assembled  workpieces  (such  as 
collars  and  cuffs).  Most  of  the  joining  operations  are 
currently  implemented  using  "hard  automation".  Gaetan  [1] 
believes  that  fabric  handling  is  the  major  labor  and  time 
consuming  part  of  apparel  manufacture.  The  productivity  of 
apparel  manufacturing  operations  can  be  significantly  im¬ 
proved  by  automating  fabric  handling  operations.  High 
capital  costs  and  technological  limitations  has  hindered  the 
application. of  advanced  automation  in  the  apparel  industry. 
With  recent  advances  in  technology  such  as  development  in 
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CAD/CAM  and  robotics,  automation  of  apparel  manufacturing 
operations  has  become  more  feasible. 

As  robotics  researchers  have  realized,  fabric  handling 
operations  are  the  most  difficult  of  the  apparel  manufactur¬ 
ing  operations  to  automate  due  to  the  inherent  flexible  and 
unpredictable  behavior  of  fabric.  For  robotics  to  be  effec¬ 
tively  applied  to  apparel  manufacture,  various  issues  such  as 
the  design  of  suitable  end-effectors  and  the  development  of 
sensing  and  control  strategies  must  be  addressed. 

Even  with  recent  developments  in  robot  technology, 
fabric  handling  poses  a  special  challenge  due  to  the  unusual 
behavior  of  the  fabric  material.  Various  research  projects 
have  been  initiated  that  involve  the  application  of  robots  to 
fabric  handling.  The  problem  of  separating  a  single  ply  from 
a  fabric  stack  has  been  extensively  investigated.  Parker, 
Dubey,  Paul,  and  Becker  [2]  explored  the  use  of  pins,  adhe¬ 
sives  and  vacuum  suction  to  separate  individual  fabric  work- 
pieces  from  a  stack.  Kemp,  Taylor,  Taylor,  and  Pugh  [3] 
developed  a  gripper  for  separating  fabric  plies  by  the  use  of 
an  air  jet  attached  to  the  upper  jaw  of  the  gripper.  Taylor, 
Monkman,  and  Taylor  [4]  experimented  with  a  device  that  makes 
use  of  the  electrostatic  attractive  force  that  develops 
between  the  gripper  material  and  fabric  to  separate  fabric 
plies  from  a  stack. 

Robot-assisted  sewing  of  fabric  pieces  represents  the 
next  level  of  sophistication  in  the  automation  of  apparel 
manufacturing.  Torgerson  and  Paul  [5]  developed  a  robot 
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workcell  for  vision-assisted  manipulation  of  single-ply  fab¬ 
ric  workpieces  with  arbitrary  contours  under  a  simulated 
sewing  needle.  Gershon  and  Porat  [6]  describe  a  flexible 
robotic  sewing  system  called  FIGARO.  The  system  manipulates 
fabric  panels  through  a  sewing  machine  to  attain  a  seam 
parallel  to  the  panel's  edge.  The  Japanese  Ministry  of 
International  Trade  and  Industry  (MITI)  [7]  has  sponsored  a 
research  program  that  "will  center  around  the  creation  of 
machinery  that  can  handle  soft,  porous  and  stretchable  fab¬ 
rics  with  the  same  dexterity  and  precision  as  industrial 
robots  now  handle  metals."  As  part  of  the  program,  a  robot 
system  for  three  dimensional  sewing  of  fabrics  was  developed 
by  Nakamura  et  al.  [8].  Two  instances  of  three  dimensional 
manipulation  tasks  that  have  been  successfully  automated 
using  robots  have  been  described  in  the  literature.  Taylor 
and  Koudis  [9]  describe  a  technique  for  the  robot  assembly  of 
the  front,  back  and  gusset  panels  for  the  manufacture  of 
men's  briefs.  The  Charles  Stark  Draper  Laboratory  has 
developed  a  robot  workstation  for  the  assembly  of  sleeves  for 
men's  tailored  suits  [10]. 

A  project  to  automate  certain  shirt  collar  manufacturing 
operations  is  being  undertaken  at  Clemson  University.  The 
shirt  collars  before  being  processed  consist  of  two  plies 
sewn  together  on  three  sides  as  shown  in  Figure  1.1.  One  of 
the  plies  has  a  fused  lining  to  impart  stiffness  to  the 
collar.  Stitching  the  collar  on  three  sides  forms  two  cor¬ 
ners  or  "collar  points".  The  two  plies  enclose  a  "collar 


stitch  Line 
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pocket".  Before  being  processed,  the  stitch  line  is  visible 
on  the  outer  surface  of  the  collar.  In  order  to  conceal  the 
seam  edge,  the  collar  must  be  inverted.  The  process  of 
inversion  is  called  "turning".  After  the  turning  process  is 
complete,  the  collar  points  must  be  "pressed"  to  obtain  sharp 
collar  points.  The  purpose  of  the  Defense  Logistics  Agency 
(DLA)  sponsored  project  is  to  design,  develop  and  demonstrate 
a  robotic  system  which  will  turn  and  press  shirt  collars 
without  operator  assistance.  The  project  involves  the  de¬ 
velopment  of  a  Robotic  Fabric  Handling  System  (RFHS) ,  com¬ 
prising  a  robot  and  an  end— effector ,  which  are  to  be  inte¬ 
grated  with  other  dedicated  collar  turning  and  pressing 
devices.  The  topic  of  this  research  is  to  develop  an  end- 
effector  that  can  manipulate  shirt  collars  and  hence  demon¬ 
strate  concepts  for  the  larger  problem  of  manipulation  of 
multiple-ply  three  dimensional  apparel  components. 

Need  for  a  Specialized  End-Effector 

A  robot  interacts  with  its  environment  through  an  end- 
effector  usually  mounted  at  its  wrist.  The  end-effector  can 
be  a  gripper  for  grasping  objects  or  a  tool  for  performing 
tasks  such  as  welding,  spray  painting  etc.  An  end-effector 
can  also  incorporate  mechanisms  for  enhancing  the  motion 
capabilities  of  the  robot. 

Robots  can  easily  manipulate  rigid  objects  once  their 
shape  and  geometry  are  known  or  determined.  However,  apparel 
workpieces  such  as  shirt  collars  behave  in  an  unpredictable 
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manner  due  to  the  flexible  or  limp  nature  of  the  fabric 
material.  In  order  to  manipulate  apparel  workpieces,  it  is 
necessary  that  the  transformation  of  a  geometric  character¬ 
istic  of  the  workpiece  be  determined  with  respect  to  the  ro¬ 
bot.  Another  important  task  that  the  end-effector  has  to 
perform  while  manipulating  multiple-ply  apparel  components  is 
to  keep  the  individual  plies  of  the  workpiece  apart.  Separa¬ 
tion  of  the  workpiece  plies  is  required  during  processing 
operations  carried  out  on  the  workpiece. 

Robot  wrist  motions  are  required  to  orient  the  end- 
effector  (and  hence  the  grasped  object) .  End-effector  orien¬ 
tation  can  be  described  in  terms  of  three  parameters;  pitch, 
roll  and  yaw  angles.  Additional  degrees  of  freedom  may  be 
provided  by  the  end-effector  orientation  to  correctly  orient 
the  apparel  workpiece  on  external  devices  that  carry  out 
processing  operations. 

An  end-effector  which  satisfies  these  design  specifi¬ 
cations  is  often  required  for  apparel  manipulation.  Custom 
designed  end-effectors  for  manipulation  of  multiple-ply, 
three  dimensional  apparel  components  are  often  necessary  for 
apparel  automation. 

Literature  Survey 

Research  into  end-effectors  has  been  directed  at  two 
levels:  (1)  general  purpose  end-effectors  which  can  handle  a 
wide  variety  of  objects  and  (2)  specialized  end-effectors 
which  are  limited  to  handling  objects  having  specific  prop¬ 
erties.  A  survey  of  general  purpose  end-effectors  and  end- 
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effectors  developed  to  handle  limp  material  will  be  presented 
to  obtain  an  overview  of  the  state-of-the-art  in  the  field. 

General  Purpose  End-Effectors 

General  purpose  end-effectors  are  designed  to  handle  a 
wide  class  of  objects  typically  by  emulating  human  actions. 
One  approach  towards  designing  an  end-effector  for  handling 
flexible  objects  is  to  design  an  anthropomorphic  end-effec¬ 
tor.  Such  an  approach  might  be  effective  considering  the 
manual  dexterity  needed  to  handle  fabric  material.  Two 
general  purpose  end-effectors  described  in  the  literature  are 
discussed. 

The  most  ambitious  research  project  regarding  the  devel¬ 
opment  of  a  general  purpose  end-effector  is  the  Utah/M. I. T. 
dexterous  hand  [11].  The  hand  illustrated  in  Figure  1.2 
consists  of  three  fingers,  each  incorporating  four  degrees  of 
freedom  and  a  thumb,  also  possessing  four  degrees-of -freedom, 
placed  opposite  to  the  fingers.  The  hand  was  designed  to 
emulate  human  capabilities.  The  sixteen  joints  of  the  hand 
are  driven  by  antagonistic  tendons  which  are  independently 
actuated  by  pneumatic  air  cylinders.  The  actuators  are 
located  remotely  to  reduce  the  weight  and  size  of  the  hand. 
Feedback  information  to  the  controller  is  provided  by  tendon 
and  joint  position  sensors.  The  Utah/M. I. T.  hand  can  be 
controlled  by  teaching  it  various  motions  using  a  "data 
glove"  that  records  motion  trajectory  points.  Due  to  its 
kinematic  complexity  and  high  cost,  the  Utah/M. I. T.  dexterous 
hand  has  been  used  only  as  a  research  tool  in  laboratories. 


Figure  1.2.  Utah/M. I. T.  Dexterous  Hand 

(Source:  Jacobsen  et  al.  [11],  International 
Journal  of  Robotics  Research) 
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Another  important  general  purpose  end-effector  is  the 
Stanford/JPL  hand  [12].  The  Stanford/JPL  hand  illustrated  in 
Figure  1.3  consists  of  three  fingers;  each  finger  is  provided 
with  three  degrees-of-freedom.  The  individual  joints  are 
actuated  by  DC  motors  which  drive  antagonistic  tendons. 
Control  of  the  fingers'  contact  forces  is  achieved  through  a 
hemispherical  force  sensor  mounted  on  each  finger  tip.  No 
industrial  applications  of  the  Stanford/JPL  hand  have  been 
reported  for  the  same  reasons  as  for  the  Utah/M. I. T.  dexter¬ 
ous  hand. 

Designing  an  end-effector  which  incorporates  general 
anthropomorphic  features  for  handling  fabric  is  difficult 
because  the  level  of  technology  is  complex  and  the  cost  is 
difficult  to  justify.  A  more  realistic  approach  is  to  de¬ 
velop  a  dedicated  end-effector  designed  specifically  for  the 
task  of  handling  particular  fabric  components.  Future  tech¬ 
nological  developments  that  reduce  the  complexity  and  lower 
costs  of  anthropomorphic  end-effectors  may  make  their  use  in 
industrial  applications  more  feasible. 

Apparel  Handling  End-Effectors 

The  sophistication  of  apparel  handling  end-effectors 
has  grown  over  the  years.  The  first  generation  of  apparel 
handling  end-effectors  were  used  for  pick-and-place  opera¬ 
tions.  Pick-and-place  end-effectors  are  designed  to  separate 
a  single  fabric  workpiece  from  a  stack  and  transport  it  to 
another  location.  Destacking  a  single  workpiece  is  a  chal¬ 
lenging  problem  due  to  the  tendency  of  adjacent  fabric  plies 


Stanford/JPL  Hand 

(Source:  Grupen  et  al.  [13], 

Journal  of  Robotics  Research) 


International 


Figure  1.3. 
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to  adhere  to  each  other  at  the  cut  edges.  Designs  of  pick- 
and-place  end-effectors  differ  in  the  mechanism  they  employ 
to  separate  individual  workpieces  from  a  stack.  The  various 
ply— separation  methods  that  have  been  reported  in  the  liter¬ 
ature  use  pins,  adhesives  and  vacuum  [2],  the  air- jet  princi¬ 
ple  [3]  and  electrostatic  forces  [4]. 

The  next  generation  of  apparel  handling  end-effectors 
used  to  guide  fabric  panels  over  a  flat  surface  during 
sewing  operations.  Torgerson  [14]  developed  a  robot  end- 
effector  that  can  guide  a  fabric  workpiece  under  a  simulated 
sewing  needle.  The  end-effector  uses  adhesive  tape  to  ac¬ 
quire  a  single  workpiece  from  a  stack.  The  unique  feature  of 
this  end-effector  is  that  the  grasp  locations  can  be  varied 
automatically  to  accomodate  workpieces  of  different  sizes. 
The  adhesive  pads  are  mounted  on  compliant  springs  so  that 
the  end-effector  can  guide  the  workpiece  smoothly  along  a 
flat  surface.  The  drawbacks  associated  with  this  end-effec¬ 
tor  is  that  large  workpieces  tend  to  sag  in  the  middle  since 
they  are  supported  only  at  the  edges  and  that  an  external 
mechanism  is  needed  to  separate  the  workpiece  from  the  end- 
effector  due  to  the  use  of  adhesives  as  the  grasping  mecha¬ 
nism.  Gershon  [15]  developed  an  end-effector  for  guiding  the 
vorkpiece  across  a  sewing  needle.  The  end— effector  consists 
of  two  fingers  whose  relative  distance  is  variable.  The 
fingers  are  equipped  with  irubber  pads  whose  friction  coeffi¬ 
cient  with  respect  to  the  fabric  is  greater  than  the  friction 
coefficient  between  the  fabric  and  the  worktable  surface. 
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This  was  done  to  prevent  slip  between  the  fingers  and  the 
workpiece.  The  difficulty  reported  with  this  end-effector  is 
its  inability  to  prevent  buckling  of  the  fabric  when  rotating 
the  workpiece  about  the  sewing  needle.  Gershon  reconunended 
the  use  of  additional  fingers  whose  relative  positions  can  be 
automatically  reconfigured  under  program  control. 

The  highest  level  of  sophistication  among  apparel  han¬ 
dling  end-effectors  are  those  that  can  manipulate  apparel 
vorkpieces  in  three  dimensional  space.  The  Charles  Stark 
Draper  laboratories  developed  an  end-effector  that  was  able 
to  fold  sleeves  for  men's  suits  [10].  The  end-effector  is 
comprised  of  numerous  "cloth  pickers"  that  are  mounted  along 
a  flexible  mechanical  spline.  The  spline  consists  of  three 
segments  -  a  central  stationary  segment  and  right  and  left 
segments  that  can  be  moved  with  respect  to  the  central  piece. 
The  shape  of  the  spline  can  be  adjusted  to  C  and  S  shapes 
that  conform  to  most  sleeve  edges.  The  configuration  of  the 
spline  is  controlled  by  visual  feedback  of  the  location  of 
the  sleeve  edge.  No  performance  measures  of  the  end-effector 
were  reported;  however,  the  cloth  folding  workstation  com¬ 
prising  the  robot,  end-effector,  vision  system  and  the  cell 
controller  performed  reliably.  Another  end-effector  capable 
of  three  dimensional  manipulation  was  developed  by  Taylor  and 
Koudis  [9].  The  end-effector  assists  in  the  assembly  of  the 
front,  back  and  gusset  panels  of  men's  briefs.  The  end- 
effector  consists  of  two  rollers  that  are  used  to  roll  the 
front  and  back  panels  of  the  briefs  and  lay  it  on  the  gusset 
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panel.  A  sewing  machine  joins  the  panels  together  to  com¬ 
plete  the  assembly.  The  rollers  on  the  end-effector  rotate 
by  180  degrees  to  turn  the  assembly  inside  out  thus  conceal¬ 
ing  the  seam. 

The  end-effectors  described  above  make  use  of  different 
design  strategies  to  solve  specific  fabric  handling  problems. 
Concepts  must  be  developed  that  enable  the  design  of  robot 
end-effectors  for  the  manipulation  of  multiple-ply  three 
dimensional  apparel  components. 

Problem  Statement  and  Research  Objectives 

This  research  problem  can  formally  be  stated  as: 

Development  of  an  end-effector  for  the  three  dimensional 
manipulation  of  multiple-ply  apparel  workpieces  and  dem¬ 
onstration  of  its  operational  capability  by  integrating 
it  into  a  workstation  for  processing  shirt  collars. 

The  first  objective  towards  achieving  this  goal  is  to 
evaluate  and  analyze  the  requirements  for  manipulating  three 
dimensional  apparel  workpieces.  Identifying  the  requirements 
of  the  end-effector  will  enable  the  conceptualization  of  the 
mechanical  design  of  the  end-effector.  Apart  from  satisfying 
the  apparel  manipulation  requirements,  the  mechanical  design 
must  consider  physical  constraints  that  influence  the  design 
such  as  robot  payload  and  workspace.  Control  schemes  devel¬ 
oped  for  the  end-ef f ector • axes  of  motions  must  be  compatible 
with  the  overall  control  structure  for  the  collar  processing 
workstation.  The  second  objective  of  the  thesis  is  to  physi¬ 
cally  realize  an  end-effector  design  incorporating  the 
developed  concepts.  Realization  of  the  design  will  involve 
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mechanical  component  design,  integration  of  control  elec¬ 
tronics  with  the  mechanical  hardware  and  development  of 
software  routines  to  command  end-effector  motions  from  a 
digital  computer.  The  final  objective  of  this  research  will 
be  to  evaluate  the  performance  of  the  developed  end-effector. 

Thesis  Organization 

Manipulation  primitives  for  multiple-ply  apparel  compo¬ 
nents  are  developed  in  Chapter  II.  These  primitives  are 
obtained  after  studying  human  operators  performing  a  similar 
task.  The  concepts  that  are  evolved  in  Chapter  II  are  tran¬ 
slated  into  an  implementable  design  in  Chapter  III.  The 
design  includes  the  mechanical  and  control  design  of  the  end- 
effector.  The  performance  of  the  end-effector  will  be  eval¬ 
uated  in  Chapter  IV.  Finally,  the  conclusions  and  recom¬ 
mendations  of  this  research  will  be  presented  in  Chapter  V. 
Appendices  A  through  E  contain  material  that  detail  the 


thesis  work. 


CHAPTER  II 


END-EFFECTOR  DESIGN  CONCEPTUALIZATION 

The  design  of  the  end-effector  must  be  based  upon  cer¬ 
tain  general  concepts  for  three  dimensional  manipulation  of 
multiple-ply  apparel  components.  These  manipulation  primi¬ 
tives  are  developed  after  studying  the  manual  manipulation  of 
a  particular  multiple-ply  apparel  component,  the  shirt  col¬ 
lar.  A  strategy  for  machine  manipulation  of  apparel  compo¬ 
nents  can  evolve  from  this  study.  A  conceptual  design  is 
developed  that  specifies  the  motion  requirements  for  the  end- 
effector. 


Definitions 


Definition  of  the  terms  used  in  the  present  and  sub 


sequent  chapters  are  given  below: 

Manipulation  :  Operation  or  handling  of  an  object  after 

it  has  been  grasped.  Examples  of  manipu¬ 
lation  operations  on  an  apparel  workpiece 
are  changing  its  position  and  orienta¬ 
tion,  folding  etc. 


Grasping 


Gripper 


Ply-Separation 


The  physical  operation  of  holding  an  ob¬ 
ject.  Grasping  can  be  achieved  by  any  of 
a  number  of  methods  such  as  gripping, 
vacuum  suction,  temporary  bonding  with 
the  workpiece  etc. 

A  mechanism  that  grasps  an  object  by 
trapping  it  between  two  or  more  "jaws". 

In  a  multiple-ply  apparel  component,  the 
action  of  keeping  the  individual  plies 
apart . 
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Analysis  of  Manual  Apparel  Manipulation 

In  order  to  devise  a  reliable  grasping  strategy,  it 
would  be  desirable  to  analyze  and  predict  the  behavior  of  the 
collar.  Unfortunately,  very  little  research  has  been  direct¬ 
ed  towards  the  study  of  fabric  behavior  under  the  action  of 
various  loads  and  boundary  conditions.  A  few  studies  have 
been  initiated  to  understand  fabric  behavior;  however,  no 
published  results  exist  that  predict  analytically  the  behav¬ 
ior  of  multiple-ply  apparel  components.  The  end-effector 
design  must  thus  be  based  on  .visual  observation  of  the  behav¬ 
ior  of  a  multiple-ply,  three  dimensional  apparel  component 
under  manual  operation.  The  manual  manipulation  of  a  shirt 
collar,  which  is  an  example  of  a  multiple-ply  apparel  compo¬ 
nent  is  studied  to  develop  a  set  of  manipulation  requirements 
for  the  end-effector. 

The  shirt  collar  must  be  turned  and  pressed  before  it 
can  be  assembled  with  the  rest  of  the  shirt.  State-of-the- 
art  collar  turning  and  pressing  is  performed  manually  on  a 
single  machine.  One  version  of  the  machine,  the  Lunapress, 
is  illustrated  in  Figure  2.1.  This  machine  is  designed  so 
that  a  human  operator  can  perform  both  turning  and  pressing 
operations  while  seated.  The  turning  components  of  the 
machine  consist  of  a  "clipper"  and  a  "turner".  The  clipper 
is  a  .stationary  flat  triangular  blade  which  points  towards 
the  operator.  The  turner  is  a  conical  component  attached  to 
the  end  of  a  pneumatic  cylinder's  rod.  The  cylinder  when 
actuated  forces  the  turner's  tip  against  that  of  the  clipper. 
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The  pressing  components  consist  of  templates  which  are  actu¬ 
ated  into  pressing  dies  by  means  of  pneumatic  cylinders. 

Manual  shirt  collar  turning  is  done  by  turning  each 
collar  point  sequentially.  The  operator  begins  the  process 
by  acquiring  a  single  workpiece  after  visual  location  of  the 
workpiece  stack.  He/she  then  uses  both  hands  to  separate  the 
two  collar  plies.  After  completing  this  step,  the  operator 
slides  his/her  hands  into  the  collar  pocket  so  that  the  right 
hand  grips  the  collar  at  the  stitch  line  while  the  left  hand 
grips  the  collar  ply  at  a  location  3-5  inches  away  from  the 
location  of  the  right  hand.  The  bottom  ply  and  the  left  half 
of  the  collar  are  allowed  to  sag  while  the  top  right  side  is 
held  taut  in  this  configuration.  The  collar  is  loaded  onto 
the  clipper  as  shown  in  Figure  2.2(a),  with  the  quality  of 
the  finished  collar  depending  upon  the  collar  point  resting 
precisely  against  the  tip  of  the  clipper.  The  turner  is 
actuated  forward  to  trap  the  collar  tip  against  the  clipper 
while  the  operator  pulls  the  collar  to  invert  the  collar 
point  as  depicted  in  Figure  2.2(b).  This  motion  of  turning 
the  collar  point  involves  a  pitching  motion  of  about  180 
degrees  at  the  wrist  of  the  operator.  The  procedure  is 
repeated  for  the  second  collar  point  resulting  in  an  inverted 
collar. 

The  collar  is  transported  from  the  turning  section  to 
the  pressing  section  and  is  inserted  over  the  right  template 
such  that  the  collar  seam  aligns  perfectly  with  the  template 
edge  as  shown  in  Figure  2.3(a).  Seam  alignment  is  critical 
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(a) 


Figure  2.2.  Manual  Shirt  Collar  Turning 


(b) 


Figure  2.3.  Manual  Shirt  Collar  Pressing 
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to  attaining  a  good  quality  on  the  finished  collar.  Improper 
seam  alignment  causes  "puckering”  of  the  collar  seam  once  it 
is  pressed.  The  operator  ensures  proper  seam  alignment  by 
rolling  the  seam  over  the  template  edge.  The  template  is 
actuated  into  the  pressing  dies  as  shown  in  Figure  2.3(b), 
where  the  collar  undergoes  pressing.  The  procedure  is  re¬ 
peated  for  the  right  half  of  the  collar. 

Manual  turning  and  pressing  operations  on  this  type 
machine  are  labor  intensive  requiring  a  high  degree  of  dex¬ 
terity  and  hand-eye  coordination  on  the  part  of  the  operator . 
Implementing  a  robot  assisted  workstation  with  such  a  machine 
is  difficult  for  two  reasons.  First,  the  machine  requires 
frequent  releasing  and  regrasping  of  each-  workpiece  during 
the  turning  and  pressing  procedures.  Grasping  the  collar  at 
a  desired  location  is  not  difficult  for  a  human  operator  who 
makes  use  of  elaborate  tactile  and  visual  sensory  capabili¬ 
ties.  The  same  task,  however,  is  difficult  for  a  robot  with 
its  limited  decision  making  and  sensory  capabilities.  Sec¬ 
ond,  a  robot  will  encounter  problems  in  maneuvering  within 
the  constrained  space  of  the  machine  to  carry  out  the  various 
manipulation  tasks. 

In  view  of  these  limitations,  the  apparel  assembly 
workstation  for  turning  and  pressing  shirt  collars  requires 
turning  and  pressing  devices  capable  of  processing  both 
collar  points  simultaneously.  This  change  from  the  manually 
operated  machine  will  reduce  the  occurrences  of  releasing  and 
regrasping  the  workpiece  by  the  robot  assisted  process. 
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Implementing  the  turning  and  pressing  operations  on  autono¬ 
mous  machines  requires  the  robot  to  transport  the  collar  from 
one  device  to  the  other  as  shown  in  Figure  2.4.  Manipulating 
the  collar  between  the  autonomous  turning  and  pressing  ma¬ 
chines  is  easier  for  the  robot  than  attempting  to  maneuver 
the  collar  within  the  constrained  space  of  the  manually 
operated  machine. 

Conceptual  Design 

Workpiece  Acquisition 

Workpieces  are  stacked  in  a  bundle  to  be  processed  in 
the  apparel  industry.  Multiple-ply  apparel  workpieces,  such 
as  shirt  collars  are  stacked  one  on  top  of  the  other  after 
the  individual  plies  are  sewn  together.  Acquisition  of  a 
single  workpiece  from  a  stack  by  a  robot  can  be  accomplished 
with  a  destacking  mechanism  implemented  in  one  of  two  possi¬ 
ble  ways: 

1.  The  destacking  mechanism  is  incorporated  into  the 
end-effector  design  itself. 

2.  The  destacking  operation  is  accomplished  using  an 
independent  destacking  device  that  presents  a  sin¬ 
gle  workpiece  to  the  robot  end-effector. 

Destacking  mechanisms  incorporated  into  the  end-effector 
design  also  act  as  mechanisms  to  hold  and  manipulate  the 
workpiece  [2,  3,  4].  The  advantage  of  including  the  de¬ 

stacking  mechanism  in  the  design  of  the  end-effector  is  that 
the  need  for  a  separate  device  is  eliminated,  thus  reducing 
system  cost.  However,  mechanisms  that  perform  the  destacking 
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PROCESSED 

COLLARS 


COLLAR 

STACK 


Figure  2.4.  Layout  of  Apparel  Assembly  Workstation  Incor¬ 
porating  Autonomous  Double  Point  Turning  and 
Pressing  Devices 
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operation  are  not  very  suitable  for  grasping  and  manipulating 
a  multiple-ply  apparel  component. 

Various  devices  are  commercially  available  that  can 
reliably  pick  and  separate  a  single  workpiece  from  a  stack. 
These  devices,  examples  of  which  are  the  Walton  picker  and 
Jetsew's  Clupicker,  are  being  widely  used  in  the  apparel 
industry.  Such  devices  could  be  used  to  separate  a  single 
workpiece  and  present  it  to  the  robot  end-effector  for  gras¬ 
ping.  The  design  of  the  end-effector  can,  therefore,  focus 
on  the  manipulation  of  three  dimensional  apparel  components. 
The  external  destacking  device  should  present  the  workpiece 
with  its  individual  plies  separated  to  the  end-effector 
grasping  mechanism. 

Grasping  Mechanism 

The  grasping  mechanism  provides  the  end-effector  with  a 
physical  means  of  holding  and  manipulating  the  workpiece. 
Grasping  mechanisms  that  have  been  used  previously  with  limp 
materials  are  pins,  adhesives,  vacuum  suction  devices,  elec¬ 
trostatic  grasping  devices  and  pinch  grippers. 

The  use  of  pins  as  a  grasping  device  involves  protruding 
the  pins  at  an  angle  into  the  fabric.  The  tension  imposed  on 
the  fabric  by  the  angled  pins  provides  the  holding  force. 
Fabric  is  released  by  simply  retracting  the  pins.  The  disad¬ 
vantage  of  this  grasping  method  is  that  delicate  fabric  may 
be  damaged  due  to  the  intrusion  of  pins  into  the  fabric. 
Experiments  were  conducted  to  explore  the  possibility  of 
using  vacuum  suction  for  grasping  fabric.  Studies  conducted 
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with  vacuum  gripping  showed  that  although  vacuum  suction 
provides  a  strong  grasping  force,  the  porous  nature  of  fabric 
allows  the  vacuvim  force  to  act  on  more  than  one  fabric  ply. 

Another  method  to  grasp  an  apparel  workpiece  could  be  to 
use  adhesives.  However,  the  adhesive  surface  needs  to  be 
replenished  because  of  deterioration.  Workpiece  release  with 
an  adhesive  grasping  device  can  only  be  accomplished  by  the 
use  of  an  external  device  to  physically  separate  the  work- 
piece  from  the  end-effector.  Electrostatic  methods  depend  on 
different  electric  characteristics  of  the  workpiece  and  the 
grasping  device  to  develop  an  attractive  force.  The  disad¬ 
vantage  of  this  method  is  that  turning  off  the  voltage  on  the 
grasping  device  does  not  ensure  release  of  the  workpiece. 
Either  an  external  mechanism  or  a  reverse  voltage  needs  to  be 
applied  to  separate  the  workpiece  from  the  end-effector.  The 
final  grasping  mechanism  that  will  be  reviewed  is  the  pinch 
gripper.  The  gripper  jaws  apply  forces  on  either  side  of  the 
grasped  object  to  keep  it  in  equilibrium. 

The  selection  of  a  particular  grasping  method  was  based 
on  the  application  of  two  criteria  which  are  important  for 
three  dimensional  apparel  manipulation: 

1.  the  ability  of  the  grasping  mechanism  to  retain. its 
hold  when  forces  are  applied  on  the  workpiece  by 
external  processing  machines  and 

2.  the  ability  of  the  grasping  mechanism  to  acquire 
the  workpiece  off  an  external  device  when  the  work- 
piece  is  in  a  three  dimensional  configuration. 

Apparel  workpieces  are  subjected  to  different  forces 
applied  by  external  devices  as  they  undergo  processing.  The 
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application  of  forces  by  external  devices  are  considered  for 
the  shirt  collar.  Metal  blades  called  clippers  that  assist 
in  the  turning  process  apply  forces  at  the  collar  points  as 
shown  in  Figure  2.5.  Forces  applied  at  the  collar  points  are 
transmitted  back  to  the  grasp  locations.  During  the  pressing 
operation  also,  forces  are  applied  along  the  collar  seam 
which  are  perceived  at  the  grasp  locations.  Due  to  the  non- 
positive  grasping  action  of  pins,  adhesives,  vacuum  suction 
and  electrostatic  grasping  mechanisms,  there  is  a  possibili¬ 
ty  that  the  forces  transmitted  back  to  the  grasp  locations 
will  cause  the  workpiece  to  slip  relative  to  the  end-effec¬ 
tor.  In  the  case  of  pinch  grippers,  it  is  always  possible  to 
design  a  mechanism  that  can  apply  sufficient  normal  force  on 
the  workpiece  to  ensure  that  no  slip  occurs  between  the 
gripper  jaws  and  the  workpiece. 

During  turning  and  pressing  operations,  the  shirt  collar 
assumes  a  three  dimensional  configuration  at  two  instances: 

1.  after  the  collar  has  been  destacked  by  the  external 
destacking  mechanism  and  is  presented  to  the  end- 
effector  for  acquisition  and 

2.  after  it  has  been  turned  and  is  ready  to  be  unload¬ 
ed  from  the  turning  machine. 

At  these  instances  the  collar  is  supported  at  only  two 
points  and  suspended  in  space  with  its  two  plies  separated. 
As  shown  in  Figure  2.6,  a  grasp  technique  that  acts  on  only 
one  surface  of  the  fabric  ply  would  be  unsuccessful  because 
any  unidirectional  force  will  simply  deform  the  fabric  with¬ 
out  obtaining  a  grasp  of  the  fabric.  Grasping  devices  such 
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Figure  2.5.  Application  of  Forces  at  the  Collar  Tips  during 
the  Turning  Process 


Figure  2.6. 


Effect  of  a  Grasping  Force  Acting  on  a  Single 
Surface  of  the  Workpiece  Ply 
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as  pins,  adhesives,  vacuum  suction  and  electrostatic  grasping 
methods  can  grasp  a  fabric  workpiece  only  when  it  is  support¬ 
ed  against  a  flat  surface;  these  methods  are  not  reliable 
when  trying  to  acquire  a  freely  suspended  apparel  component 
due  to  the  lack  of  a  rigid  support.  A  two- jaw  pinch  gripper 
applies  a  normal  force  on  both  sides  of  the  collar  as  depict¬ 
ed  in  Figure  2.7.  This  ensures  that  the  workpiece  is  grasped 
without  distorting  its  shape. 

Grasp  Locations 

While  handling  apparel  components,  the  workpiece  needs 
to  be  temporarily  transformed  from  a  limp  object  into  an 
object  whose  attributes  can  be  predicted  and/or  controlled. 
This  can  be  accomplished  by  stiffening  the  fabric  by  chemical 
means  or  by  stretching  the  fabric  between  the  grasp  loca¬ 
tions.  Stiffening  the  fabric  can  be  accomplished  by  chemical¬ 
ly  treating  it;  however,  the  time  and  cost  of  the  additional 
process  is  difficult  to  justify.  The  fabric  can  also  be 
rendered  stiff  by  grasping  the  workpiece  at  suitable  loca¬ 
tions  at  the  edges  so  that  fabric  droop  is  minimized.  Deter¬ 
mination  of  the  number  and  placement  of  the  grasp  locations 
is  the  next  step  in  the  conceptual  design  of  the  end-effec¬ 
tor. 

A  robot  can  position  and  orient  a  rigid  object  by  grasp¬ 
ing  it  at  a  single  stable  location.  Once  it  has  been 
grasped,  the  transformation  between  the  object  and  the  robot 
base  is  deterministic  throughout  the  motion  sequence.  Hence, 
transporting  the  grasped  object  from  one  location  to  another 


31 


Figure  2.7. 


Application  of  Forces  on  Both  Sides  of  a  Fab 
ric  Ply  by  a  Pinch  Gripper 
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simply  involves  the  solution  of  the  inverse  kinematics  of  the 
robot  manipulator.  The  process  of  manipulating  an  apparel 
component  is  different  from  that  for  a  rigid  body  because  of 
the  limp  behavior  of  the  workpiece.  Figure  2.8  shows  the 
assignment  of  frames  for  the  robot,  end-effector,  workpiece, 
and  the  turning  machine  for  loading  the  collar  on  the  turning 
machine.  The  operation  of  loading  the  collar  on  the  turning 
machine  has  been  represented  as  a  two  dimensional  occurrence 
for  convenience.  However,  the  following  analysis  can  be 
extended  to  take  into  account  the  three  dimensional  nature  of 
the  collar  manipulation  process. 

The  equation  determining  %,  the  transformation  between 
the  collar  tip  and  the  base  of  the  robot,  is  given  by 

Ct^  =  .  (2.1) 

^Tg  is  the  transformation  between  the  collar  tip  and  the  end- 
effector  base  and  ^Tg  is  the  transformation  relating  the 
position  and  orientation  of  the  end-effector  base  with  the 
base  of  the  robot.  In  order  to  determine  '^Tg,  the  collar  must 
be  controllable  to  minimize  fabric  droop  at  the  edges. 
Grasping  a  limp  apparel  component  at  only  one  location  will 
cause  the  fabric  to  droop  excessively  so  that  the  transfor¬ 
mation  between  the  fabric  edges  and  the  end-effector  base 
cannot  be  determined.  Grasping  the  workpiece  at  two  loca¬ 
tions  spaced  sufficiently  apart  ensures  that  fabric  droop  at 
the  edges  is  minimized.  Sagging  of  the  fabric  between  the 
two  grasp  locations  can  be  minimized  by  moving  the  grasp 
locations  laterally  apart  till  the  workpiece  is  taut.  These 
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Figure  2.8. 


Frame  Assignment  for  the  Shirt  Collar  Process¬ 
ing  System 
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grasp  locations  must  be  on  one  of  the  component  plies  to  keep 
the  workpiece  in  a, horizontal  configuration. 

The  location  of  the  clipper  tip  with  respect  to  the 

robot  base  can  be  determined  from 

Ttb  =  ,  (2.2) 

When  the  collar  point  coincides  with  the  clipper  tip,  ^Tg  and 
^Tg  are  identical  i.e., 

CTg  =  .  (2.3) 

Substituting  for  ^Tg  from  Equation  2.1,  we  get 

iTg  =  ^  (2.4) 

and,  hence,  ^Tg,  the  required  end-effector  position  and  orien¬ 
tation  to  correctly  load  the  collar  points  on  the  turning 
machine  clippers  is  determined  by 

ETg  =  Ct^-1  .  (2.5) 

Plv-Seoaration 

Individual  plies  of  multiple-ply  apparel  components  need 
to  be  separated  while  being  manipulated  so  that  device  ele¬ 
ments  that  assist  in  processing  operations  can  be  introduced 
between  the  workpiece  plies.  During  shirt  collar  turning  and 
pressing  operations,  flat  metal  blades  called  clippers  and 
pressing  templates  are  inserted  between  the  collar  plies. 

Different  possibilities  exist  for  ensuring  separation  of 
component  plies.  One  possibility  is  to  make  use  of  an  exter¬ 
nal  mechanism  to  separate  the  individual  plies.  Another 
possibility  is  to  make  use  of  gravity  force  to  ensure  ply- 
separation.  Figure  2.9  conceptualizes  the  design  of  a  device 
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Figure  2.9.  External  Ply-Separating  Mechanism 
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that  when  introduced  between  the  plies  stretches  the  work- 
piece  between  opposite  seams.  Due  to  the  physical  presence 
of  the  device  between  the  workpiece  plies  and  the  stretching 
action  of  the  device,  the  plies  remain  separated.  The  disad¬ 
vantage  of  this  method  is  that  the  presence  of  a  ply-separat¬ 
ing  device  between  the  workpiece  plies  interferes  with  other 
elements  or  components  that  are  introduced  into  the  apparel 
workpiece. 

A  multiple-ply  apparel  component  held  in  a  horizontal 
configuration  and  grasped  on  its  upper  ply,  results  in  the 
lower  ply  sagging  due  to  gravity.  Since  the  upper  ply  is  in 
tension  due  to  the  lateral  force  applied  between  the  two 
grippers,  and  the  lower  ply  is  sagging,  a  pocket  opening  is 
created  between  the  two  plies  as  shown  in  Figure  2.10.  Ob¬ 
servation  showed  that  workpieces  of  the  same  size  when 
grasped  at  the  same  two  locations  consistently  develop  equal 
openings  between  the  two  plies.  Also  this  method  has  an 
advantage  over  positive  action  ply-separation  devices  in  that 
no  devices  are  introduced  into  the  apparel  workpiece,  mini¬ 
mizing  interferences  with  external  mechanisms.  The  disadvan¬ 
tage  associated  with  this  method  is  that  gravity  separation 
of  component  plies  works  only  when  the  workpiece  is  being 
manipulated  parallel  to  the  horizontal  ground  surface. 

End-Effector  Orientation  Motions 

Many  apparel  manufacturing  and  assembly  operations  are 
carried  out  in  horizontal  planes.  SCARA  (Selective  Compli¬ 
ance  Assembly  Robot  Arm)  robots  use  two  degrees-of-freedom  to 


Figure  2.10.  Gravity  Separation  of  Workpiece  Plies 
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position  a  worlcpiece  in  a  plane  and  a  third  degree—of—freedoni 
to  move  the  workpiece  between  planes  and  hence  would  be 
suitable  for  apparel  processing  operations.  An  AdeptOne 
robot,  depicted  in  Figure  2.11,  which  is  a  SCARA  robot  is  to 
be  used  in  the  research.  The  robot  incorporates  three  de- 
grees~of “freedom  to  position  the  payload  within  its  work— 
space.  In  general,  three  end-effector  orientation  angles  - 
roll,  pitch  and  yaw  are  required  to  orient  a  grasped  object. 
One  possible  combination  of  the  orientation  angles  for  a 
SCARA  robot  is  depicted  in  Figure  2.12. 

The  roll  motion  is  required  while  orienting  the  collar 
on  the  turning  and  pressing  machines.  The  AdeptOne  robot  is 
equipped  with  the  roll  motion  and  thus  need  not  be  incorpo¬ 
rated  in  the  design  of  the  end-effector.  Yaw  is  a  rotation 
of  the  end-effector  about  an  axis  perpendicular  to  the  roll 
axis.  Since  all  operations  are  carried  out  in  horizontal 
planes  that  are  parallel  to  one  another,  the  yaw  motion  is 
not  required  for  the  manipulation  of  workpieces  in  horizontal 
planes.  The  third  orientation  angle  is  the  pitch  and  is  the 
motion  that  changes  the  elevation  of  the  end-effector  with 
respect  to  the  robot  wrist.  Pitching  the  end-effector  causes 
the  grasped  ply  to  change  its  orientation  whereas  the  freely 
suspended  ply  remains  relatively  unaffected  by  the  pitch 
motion.  Hence,  the  end-effector  pitch  motion  increases/- 
(jecreases  the  opening  between  the  plies  as  shown  in  Figure 
2.13.  Also,  the  pitch  motion  ensures  that  the  end-effector 
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^  ROLL 


Figure  2.12.  End-Effector  Orientation  Angles  on  a  SCARA 
Robot 
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Figure  2.13. 


Increasing  Ply-Separation  Using  End-Effector 
Pitch  Motion 
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is  oriented  to  avoid  collisions  with  the  turning  and  pressing 
machines  while  loading  and  unloading  the  collar. 


Conceptual  Design  Summary 

The  conceptual  design  has  identified  the  following 
manipulation  primitives  and  motion  requirements  of  the  end- 
effector  for  the  three  dimensional  manipulation  of  multiple- 
ply  apparel  workpieces. 

1.  Two  pinch  grippers  are  required  to  hold  the  top 
ply.  The  bottom  ply  is  allowed  to  sag  freely, 
providing  ply-separation.  The  grippers  are  to 
accept  the  workpiece  from  an  external  ^  destacking 
mechanism. 

2.  The  distance  between  the  grippers  should  be  adjust¬ 
able  to  stretch  the  grasped  ply.  The  motion  allows 
control  of  fabric  drape  at  the  collar  tips.  Vari¬ 
ability  in  the  grasp  locations  enables  the  end- 
effector  to  handle  a  range  of  workpiece  sizes. 

3.  A  pitch  orientation  motion  is  required  on  the  end- 
effector  to  orient  the  grippers  for  collar  acquisi¬ 
tion  from  the  destacking  and  turning  machines  and 
to  load  the  grasped  collar  on  the  turning  and  pres¬ 
sing  machines.  The  pitch  motion  also  enables  con¬ 
trol  of  the  separation  between  the  individual  plies 
of  the  workpiece. 

Figure  2.14  shows  a  schematic  of  the  conceptual  design. 


Conceptual  End-Effector  Desii — 


CHAPTER  III 


MECHANICAL  AND  CONTROL  SYSTEM  DESIGN 
Introduction 

Mechanical  and  control  hardware  must  be  developed  to 
implement  the  end-effector  motions  required  for  the  three 
dimensional  manipulation  of  multiple-ply  apparel  workpieces. 
The  following  factors  must  be  addressed  in  sequence  to  effect 
each  of  the  motions  on  the  end-ef fector T 

1.  selection  of  mechanisms  that  can  physically  realize 
the  conceptualized  motions, 

2 .  selection  of  actuators  to  drive  the  mechanisms  and 

3.  design  of  controllers  for  each  actuator. 

The  design  concepts  developed  in  the  previous  chapter 
will  be  demonstrated  for  robot  assisted  processing  of  shirt 
collars.  The  required  attributes  of  the  end-effector  were 
quantified  before  developing  the  detailed  design.  The  end- 
effector  is  to  be  integrated  with  the  robot  that  assists 
shirt  collar  manufacturing  operations.  The  end-effector 
design  considers  constraints  imposed  by  the  robot  workspace 
and  payload.  The  control  system  for  the  end-effector  is 
compatible  with  the  hierarchical  control  scheme  that  super¬ 
vises  and  controls  all  operations  of  the  collar  processing 


workstation. 


45 


End-Effector  Specifications 

Specifications  were  defined  that  quantified  the  desired 
characteristics  of  each  end-effector  motion.  The  specifica¬ 
tions  satisfy  the  requirements  for  shirt  collar  manipulation 
since  the  end-effector  is  to  be  integrated  with  a  workstation 
for  processing  shirt  collars. 

The  gripper  jaw  opening  should  be  wide  enough  so  that 
the  collar  is  reliably  grasped  by  both  grippers.  The  jaws  of 
the  two  grippers  are  always  at  the  same  horizontal  elevation 
due  to  the  SCARA  robot  configuration.  However,  fabric  drape 
is  not  predictable  and  maybe  greater  at  one  part  of  the 
collar  than  the  other.  When  the  workpiece  is  not  horizontal, 
the  end-effector  cannot  grasp  the  collar  at  both  locations  if 
the  gripper  jaws  are  not  wide  enough  as  shown  in  Figure  3.1. 
Any  errors  in  the  transmission  systems  of  the  robot  and/or 
the  end-effector  joints  will  manifest  itself  as  an  error  in 
the  position  of  the  gripper  jaw  opening.  The  opening  between 
the  two  gripper  jaws  must  be  wide  enough  to  compensate  for 
these  errors.  A  gripper  jaw  opening  of  0.5  inch  appears 
sufficient  to  grasp  the  collar  during  the  processing  opera¬ 
tions. 

Observations  indicate  that  the  minimum  distance  between 
the  grippers  while  handling  the  smallest  size  of  collars  is 
about  6  inches  and  the  maximum  distance  between  the  grippers 
while  handling  the  largest  size  of  collars  is  about  15  inch¬ 
es.  Hence,  a  range  of  motion  that  will  position  the  grippers 
from  6  inches  to  15  inches  apart  relative  to  one  another  is 


GRIPPER  FAILS  TO  GRASP  COLLAR 
DUE  TO  INSUFFICIENT  JAW  OPENING 


.1. 


Inability  of  End-Effector  to  Grasp  Collar  Due 
to  Insufficient  Jaw  Opening 
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adequate.  A  relative  velocity  of  2  inches/second  between  the 
grippers  will  ensure  quick  process  execution.  The  pitch 
motion  is  to  be  designed  for  a  range  of  +90  to  -90  degrees 
with  a  maximum  speed  of  +/—  45  degrees/second . 

Robot  Workspace  and  Pavload 

The  workspace  of  the  AdeptOne  robot  is  depicted  in 
Figure  3.2.  The  outer  boundary  of  the  robot  workspace  ex¬ 
tends  to  31.5  inches  from  the  robot  base  while  the  inner 
boundary  is  9  inches  from  the  center  of  the  robot  base.  The 
end-effector  must  be  compact  so  that  it  does  not  collide  with 
the  robot  column  when  the  arm  is  fully  retracted.  The  pay- 
load  of  the  AdeptOne  robot  is  limited  to  20  pounds.  Since 
the  weight  of  the  apparel  workpiece  is  almost  negligible,  the 
weight  of  the  end-effector  should  be  within  the  robot  pay- 
load. 


Hierarchical  Control  for  the  Collar 
Processing  Workstation 

A  hierarchical  semi-autonomous  control  scheme  is  pro¬ 
posed  for  accomplishing  the  collar  processing  operations 
[16].  The  hierarchy  consists  of  the  strategic  planner, 
system  coordinator,  and  devices  that  alter  the  state  of  the 
collar.  The  workstation  hardware  consists  of  the  robot,  end- 
effector,  turning  and  pressing  devices,  vision  sensors,  robot 
controller,  vision  controller  and  system  supervisor.  Figure 
3.3  shows  the  layout  and  components  of  the  apparel  assembly 
workstation  for  processing  shirt  collars.  The  strategic 
planner  and  system  coordinator  is  implemented  on  a  PC/AT 
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Figure  3.2.  Workspace  of  AdeptOne  Robot 


ROBOT 


END-EFFECTOR 

CONTROLLER 


BP-tKgIDH 

CAieU 


CAieU  2 


uieu  3 


Figure  3.3. 


Control  Hierarchy  for  the  Collar  Processing 
Workstation 
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compatible  computer  designated  as  the  system  supervisor.  The 
system  supervisor  communicates  with  the  robot  and  vision 
controllers  through  RS-232  lines.  The  end-effector  and  the 
turning  and  pressing  devices  receive  commands  and  report 
their  status  through  the  backplane  interface  of  the  PC  bus. 
The  operator  leads  the  system  through  the  various  steps  for 
collar  turning  and  pressing.  The  strategic  planner  deter¬ 
mines  off-line  the  plan  for  all  activities  which  when  execut¬ 
ed  in  the  correct  sequence  accomplish  the  required  task.  The 
system  coordinator  generates  commands  for  each  individual 
activity  such  as  motion,  sensing,  communication  between 
computers  etc. 

The  end-effector  must  be  capable  of  interpreting  and 
executing  the  high  level  commands  issued  by  the  system  coor¬ 
dinator.  The  end-effector  controller  is  implemented  on  a 
motion  controller  board  that  can  control  up  to  eight  axes  of 
motion.  Figure  3.4  shows  the  block  diagram  of  the  end-effec¬ 
tor  controller.  The  motion  controller  board  consists  of  a 
'mother'  board  that  can  accommodate  up  to  eight  different 
Aodules  and  mounts  onto  a  slot  on  the  backplane  of  a  PC/AT 
compatible  computer.  Each  module  on  the  mother  board  is 
capable  of  controlling  a  single  actuator.  The  board  also  in¬ 
cludes  16  lines  of  digital  I/O  lines  for  controlling  and 
recording  the  status  of  binary  devices  and  four  8-bit  analog 
to  digital  converters  for  data  acquisition. 
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Figure  3.4.  End-Effector  Controller  Block  Diagram 
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Gripping  Motion 

The  end-effector  employs  pinch  grippers  to  grasp  the 
apparel  workpiece.  Various  mechanisms  exist  that  can  accom¬ 
plish  the  two  jaw  gripping  action  [17].  The  gripping  action 
can  be  implemented  either  by  custom  designing  the  mechanism 
or  by  selecting  the  mechanism  from  a  commercial  vendor. 
Commercial  grippers  that  address  the  requirements  of  the 
application  are  available  in  two  configurations  -  parallel 
and  angular  motion  grippers.  Gripping  action  for  angular 
motions  is  accomplished  by  swivelling  the  gripper  jaws  about 
a  pivot  point.  The  parallel  motion  gripper  which  employs  a 
translatory  jaw  motion,  is  chosen  for  handling  collars  for 
the  following  reasons; 

1.  Parallel  motion  type  grippers  apply  a  uniform  force 
across  the  surface  area  of  the  gripper  jaw. 

2.  Parallel  motion  of  the  jaws  provides  the  opportu¬ 
nity  to  introduce  break  beam  sensors  for  future 
additions  to  the  end-effector  design. 

Avoidance  of  collisions  of  the  end-effector  with  exter¬ 
nal  devices  while  loading  or  unloading  the  collar  must  be 
considered  in  the  design  of  the  gripper  jaws.  An  L-shaped 
jaw  design  depicted  in  Figure  3.5  decreases  the  possibility 
of  the  end-effector  colliding  with  the  turning  and  pressing 
devices.  The  gripping  surface  consists  of  a  rubber  pad 
bonded  onto  an  aluminum  backing.  The  rubber  pads  consist  of 
tiny  circular  elevated  areas  that  help  in  trapping  the  fabric 
material  firmly  between  the  gripper  jaws. 


Figure  3.5.  L-Shaped  Gripper  Jaw  Design 
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Control  of  the  grippers  could  be  achieved  in  a  number  of 
ways:  electrical,  hydraulic  or  pneumatic.  Pnevunatic  actua¬ 
tors  are  ideally  suited  to  control  the  type  of  two  state 
motion  represented  by  the  open  and  close  motion  of  the  grip¬ 
pers.  The  gripper  that  was  procured  has  a  built-in  air 
cylinder  to  actuate  the  gripper  jaws.  The  state  of  the  air 
cylinder  is  controlled  by  pneumatic  solenoid  valves,  directly 
commanded  from  the  digital  I/O  lines  of  the  end-effector 
controller. 

The  open  and  close  motion  of  each  gripper  is  controlled 
independently  to  correct  for  possible  offset  of  the  grasp 
J.ocations  from  the  center  of  the  collar  as  shown  in  Figure 
3.6(a),  Since  the  turning  and  pressing  machines  process  both 
collar  points  simultaneously,  it  must  be  ensured  that  both 
collar  points  are  loaded  correctly  on  the  external  processing 
devices.  When  the  collar  is  unsymmetrically  grasped,  trans¬ 
formations  of  each  collar  point  with  respect  to  the  robot 
wrist  have  to  be  determined  in  turn.  This  increases  the 
computational  burden  on  the  robot  controller  and  will  involve 
additional  motions  by  the  end-effector. 

The  entire  process  is  rendered  slower  and  more  compli¬ 
cated  due  to  the  unsymmetrical  grasping  of  the  collar.  This 
situation  can  be  corrected  by  actuating  the  gripper  that  is 
closer  to  the  center  line  of  the  collar  and  allowing  the 
other  to  remain  open  (see  Figure  3.6(b)).  Moving  the  two 
grippers  apart  will  cause  the  collar  to  move  with  respect  to 
the  open  gripper  as  illustrated  in  Figure  3.6(c).  After 
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moving  the  grippers  so  that  the  center  line  of  the  collar  is 
in  between  the  two  grasp  locations,  the  open  gripper  is 
actuated  to  grasp  the  collar. 

Lateral  Gripper  Motion 

The  motion  of  the  grippers  that  moves  them  relative  to 
one  another  is  implemented  for  the  following  reasons; 

1.  to  tension  the  fabric, 

2.  to  be  able  to  handle  different  collar  sizes, 

3.  to  be  able  to  vary  the  grasp  locations  during  a 
cycle  of  operation  and 

4.  to  be  able  to  adjust  for  any  unsymmetric  grasping 
of  the  apparel  workpiece. 

The  lateral  motion  of  the  two  grippers  can  be  such  that 
(a)  each  gripper  translates  independently  of  the  other  or  (b) 
the  grippers  translate  simultaneously  with  respect  to  one 
another.  Translating  the  grippers  independently  of  one  an¬ 
other  will  disturb  the  symmetric  location  of  the  grippers 
with  respect  to  the  collar  center.  The  undesirable  effects 
of  this  situation  has  been  explained  in  the  previous  section. 
Hence  the  implementation  of  the  lateral  gripper  motion  on  the 
end-effector  will  be  such  that  the  grippers  translate  simul¬ 
taneously  relative  to  one  another. 

Three  different  mechanisms  were  considered  for  imple¬ 
menting  the  lateral  motion  of  the  grippers.  Figure  3.7 
illustrates  a  mechanism  employing  pneumatic  actuation  of  the 
motion.  The  pneumatic  cylinder  transmits  motion  to  the 
grippers  through  a  cable  drive.  The  return  motion  of  the 
grippers  is  actuated  by  springs.  A  servo  valve  continuously 


Figure  3.7.  Pneumatically  Actuated  Lateral  Gripper  Motion 
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controls  the  position  of  the  pneumatic  cylinder.  Feedback  is 
achieved  through  a  linear  potentiometer  that  directly  moni¬ 
tors  the  position  of  the  air  cylinder.  Pnevimatic  cylinders 
are  low  cost  and  light  weight,  and  can  be  easily  incorporated 
in  the  apparel  industry,  where  typically  ''shop''  air  supply  is 
widely  available.  However,  the  large  dimension  of  the  air 
cylinder  makes  the  end-effector  design  bulky  and  could  cause 
interferences  with  the  robot  workspace.  Various  other  prob¬ 
lems  have  been  reported  with  pneumatic  servo  control  of  robot 
mechanisms  such  as  air  compressibility  and  transport  delay 
[18]. 

The  second  alternative  depicted  in  Figure  3.8  moves  the 
grippers  through  a  belt  drive.  The  carriages  that  transport 
the  gripper  are  attached  to  segments  of  the  belt  that  move  in 
opposite  directions.  The  disadvantage  of  this  method  is  that 
the  unequal  pulling  forces  on  the  tight  and  slack  sides  of 
the  belt  may  cause  different  dynamic  behavior  of  the  grip¬ 
pers. 

The  mechanism  represented  in  Figure  3 . 9  involves  the  use 
of  an  electric  motor.  The  motor  actuates  left  and  right  hand 
ball  screws  so  that  depending  on  the  direction  of  motor 
rotation,  the  ball  nuts  move  towards  or  away  from  each  other. 
The  ball  screw  mechanism  was  chosen  for  its  low  friction, 
tight  tolerances  and  high  efficiency. 

The  arrangement  of  the  lateral  gripper  motion  as  shown 
in  Figure  3.9  occupies  considerable  space.  Since  the  dis¬ 
tance  between  the  grippers  is  to  range  from  6"  to  15",  the 


Figure  3.8. 


Belt  Drive  for  Lateral  Gripper  Motion  Actua¬ 
tion 


Figure  3.9. 


Ball  Screw  Mechanism  for  Lateral  Gripper  Mo¬ 
tion  Actuation 
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dimension  of  the  end— effector  along  the  direction  of  motion 
of  the  grippers  will  be  at  least  15*'.  The  clearance  between 
the  robot  base  post  and  the  center  of  the  robot  tool  post  is 
less  than  6”  when  the  robot  is  fully  retracted.  As  shown  in 
Figure  3.10,  execution  of  a  roll  motion  in  this  robot  posi¬ 
tion  is  likely  to  result  in  the  end-effector  colliding  with 
the  robot  base.  To  avoid  collision  with  the  robot,  'soft 
stops'  nee  to  be  programmed  into  the  robot  workspace.  Soft 
stops  prevent  the  robot  from  accessing  certain  regions  in  its 
workspace.  The  ball  screw  mechanism  is  modified  to  avoid 
reducing  the  operating  space  of  the  robot.  The  grippers  can 
be  drawn  close  together  as  shown  in  Figure  3.11(a)  when  the 
end-effector  needs  to  perform  a  roll  motion  near  the  inner 
boundary  of  the  robot  workspace,  so  that  the  end-effector 
clears  the  robot  post.  Figures  3.11(a)  and  (b)  show  the 
overlapping  motion  of  the  ball  nuts  that  enables  the  end- 
effector  design  to  be  compact. 

The  selection  of  the  actuator  was  narrowed  to  a  choice 
between  a  stepper  motor  and  d.c.  servo  motor.  Since  a  more 
or  less  uniform  torque  is  required  to  actuate  the  lateral 
gripper  motion,  it  is  unlikely  that  an  open  loop  stepper 
motor  would  loose  steps.  Even  a  few  steps  that  might  be 
missed  would  not  significantly  affect  the  accuracy  of  the 
motion  due  to  the  small  lead  (0.125")  of  the  ball  screw  mech¬ 
anism. 

The  selection  of  the  stepper  motor  was  based  on  a  se¬ 
lection  procedure  which  involves  ensuring  that  the  inertia  of 
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the  load  and  the  motor  rotor  are  matched  so  that  resonant 
conditions  do  not  occur.  The  selection  procedure  also  en¬ 
sures  that  the  desired  speed  and  acceleration  can  be  achieved 
by  the  candidate  motor.  A  motor-driver  package  was  chosen 
that  satisfied  the  torque  and  speed  requirements  of  the 
application.  A  two  to  one  speed  reduction  ratio  achieved 
through  a  timing  belt  drive  is  required  to  match  the  load 
inertia  with  the  inertia  of  the  motor  rotor . 

The  block  diagram  of  the  step  motor  system  is  shown  in 
Figure  3.12.  The  system  supervisor  sends  out  high  level 
commands  to  the  end-effector  controller  to  actuate  the  lat¬ 
eral  gripper  motion.  The  mother  board  of  the  end— effector 
controller  commands  the  step  motor  controller  module  to 
output  the  step  and  direction  signals  to  the  motor  driver. 
The  driver  translates  the  step  and  direction  signals  into  the 
correct  motor  winding  on  and  off  sequences  to  rotate  the 
motor  by  the  desired  number  of  steps  in  the  required  direc¬ 
tion.  The  driver  also  performs  the  function  of  amplifying 
the  signals  into  voltage  levels  that  can  drive  the  motor. 
The  motor  converts  the  electrical  input  from  the  driver  into 
rotational  movement.  The  load  represented  by  the  ball  screw 
mechanism  driving  the  grippers  is  driven  by  the  timing  belt. 

Pitching  Motion 

The  pitching  motion  of  the  end-effector  was  implemented 
for  the  following  reasons: 
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Figure  3.12.  Block  Diagram  of  Lateral  Gripper  Motion 
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1.  to  correctly  orient  the  grippers  prior  to  acquiring 
the  collar  from  the  destacking  device  and  the  turn¬ 
ing  machine, 

2.  to  align  the  grasped  collar  on  external  processing 
devices  and 

3 .  to  increase  or  decrease  the  opening  between  the 
workpiece  plies. 

The  initial  design  concept  considered  for  the  pitch 
motion  is  shown  in  Figure  3.13.  This  design  requires  the 
motor  actuating  the  pitch  motion  to  support  the  large  static 
imbalance  torque  developed  because  of  the  mass  of  the  grip¬ 
pers  and  the  mechanism  that  moves  the  two  grippers  laterally 
with  respect  to  each  other.  The  maximum  torque  required  by 
the  actuator  can  be  reduced  by  bringing  the  center  of  gravity 
of  the  end-effector  as  close  as  possible  to  the  pitch  axis. 
The  center  of  gravity  of  the  end-effector  can  be  shifted 
closer  to  the  pitch  axis  by  using  a  counterbalancing  mass. 

The  strategy  adopted  to  counterbalance  the  gripper  mass 
is  illustrated  in  Figure  3.14.  Motion  is  transmitted  from 
the  motor  to  the  pitch  axis  by  a  positive  belt  drive.  The 
driven  pulley  is  fixed  relative  to  a  non— rotating  shaft.  A 
torque  applied  at  the  axis  of  the  rotating  pulley  develops  a 
reaction  moment  about  the  shaft  axis  causing  the  end-effector 
to  swivel  about  the  axis.  Since  the  motor  is  mounted  on  the 
opposite  side  of  the  gripper  mass,  it  acts  as  a  counterbal¬ 
ance  to  the  rest  of  the  end-effector  mass. 

Two  types  of  motors,  d.c.  servo  and  stepper  motors,  were 
considered  to  actuate  the  pitch  motion.  Step  motors  do  not 
perform  well  when  required  to  handle  large  inertial  loads. 


Figure  3.13.  Preliminary  End-Effector  Design 


Figure  3.14. 


End-Effector  Pitch  Motion  Incorporating  Coun 
terbalancing  Concept 
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Steps  missed  by  a  step  motor  due  to  temporary  overloads  would 
cause  loss  of  positional  information  of  the  pitch  axis.  This 
uncertainty  about  the  status  of  the  pitch  motion  is  likely  to 
lead  to  poor  end-effector  performance.  Hence,  a  d.c.  servo 
motor  with  a  position  feedback  sensor  was  chosen  as  the 
actuator  for  the  pitch  motion. 

A  gear  ratio  was  chosen  to  ensure  that  the  inertia  of 
the  motor  matched  the  reflected  inertia  at  the  pitch  axis. 
Two  possible  candidates  were  considered  for  implementing  the 
gear  ratio:  planetary  gearhead  and  harmonic  drive.  The 
planetary  gearhead  was  chosen  for  its  low  backlash,  high 
efficiency,  low  cost,  compact  size  and  its  integxation  with 
the  servo  motor.  A  gear  ratio  of  105:1  was  determined  to  be 
required;  the  ratio  is  divided  between  the  planetary  gearhead 
(35:1)  and  the  positive  drive  belt  (3:1).  The  division  of 
the  gear  ratio  causes  the  reflected  backlash  (of  the  gear- 
head)  to  be  reduced  in  the  3:1  ratio  at  the  pitch  axis. 

A  linear  servo  amplifier  operating  in  a  torque  control 
mode  drives  the  d.c.  motor.  An  optical  incremental  encoder 
with  quadrature  output  performs  the  function  of  the  position 
feedback  device.  Angular  positional  information  can  be 
obtained  either  at  the  motor  axis  or  at  the  axis  of  the  pitch 
motion.  Locating  the  encoder  at  the  motor  shaft  provides 
more  encoder  counts  per  degree  of  rotation  of  the  pitch  axis 
due  to  the  large  gear  ratio.  The  resulting  increased  resolu¬ 
tion  of  the  position  measurement  improves  the  accuracy  of  the 
pitch  motion.  However,  backlash  and  compliance  present  in 


70 


the  transmission  system  cannot  be  sensed  by  an  encoder  moun¬ 
ted  at  the  motor  axis. 

Mounting  the  encoder  at  the  axis  of  rotation  can  com¬ 
pensate  for  backlash  and  compliance  present  in  the  load 
system;  however,  the  decreased  resolution  and  the  tendency  of 
the  mechanism  to  hunt  for  the  desired  position  requires  the 
location  of  the  encoder  at  the  axis  of  the  motor  shaft. 
Encoder  signals  are  read  by  a  position  counter,  detecting 
each  logic  transition  occurring  at  the  quadrature  inputs. 
This  increases  the  resolution  of  the  encoder  by  a  factor  of 
four. 

The  control  system  block  diagram  for  the  pitch  motion  is 
shown  in  Figure  3.15.  The  servo  module  on  the  end-effector 
controller  board  contains  a  trapezoidal  velocity  profile 
generator.  A  digital  Proportional-Derivative-Integral  con¬ 
trol  algorithm  is  implemented  in  the  module  according  to  the 
following  equation: 

Jr 

u(kT)  -  KpeikT)  +  Ki'^eikT)  +  -e(Jc-l)  r']  (3.1) 

where 

Kp  =  proportional  gain, 

Kj  =  derivative  gain, 

K,-  =  integral  gain, 

e(kT)=  error  signal  at  instant  kT, 

T  =  sampling  time,  and 

T'  =  sampling  time  for  the  derivative  part. 
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Figure  3.15.  Block  Diagram  of  Pitch  Motion  System 
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The  proportional  term  provides  a  signal  that  is  propor¬ 
tional  to  the  position  error.  The  derivative  term  provides 
rate  feedback  information  by  increasing  the  apparent  system 
damping.  The  integration  term  ideally  drives  the  error  to 
zero.  (However,  presence  of  coulomb  friction  and  dead  zones 
in  real  systems  causes  a  small  steady  state  error  to  be 
present. ) 

Analysis  of  Pitch  Motion 

An  analysis  of  the  pitch  motion  was  conducted  to  under¬ 
stand  the  kinematic  and  dynamic  characteristics  of  the  coun¬ 
terbalancing  concept.  The  kinematic  relationship  between  the 
angular  rotation  of  the  motor  shaft  and  the  pitch  displace¬ 
ment  is  shown  in  Figure  3.16.  The  kinematic  equation  of  the 
pitch  motion  is  given  by 

±  .  A  -  1  (3-2) 
6  r  ^  • 


The  absolute  angular  velocities  of  the  motor  shaft  and  the 
pitch  rotation  are  <j>  and  6  respectively.  The  radii  of  the 
non-rotating  and  rotating  pulleys  are  R  and  r  respectively. 

The  following  assumptions  were  made  in  the  derivation  of 
the  end-effector  pitch  dynamic  equations  of  motion: 

1.  The  dynamics  of  the  robot  and  the  end-effector  are 
decoupled.  This  is  true  during  most  motion  tra¬ 
jectories  involving  simultaneous  end-effector  and 
robot  motion.  The  end-effector  executes  the  pitch 
motion  during  collar  loading  or  unloading  opera¬ 
tions  on  external  processing  devices,  during  which 
times  the  robot  links  are  either  stationary  or 
moving  at  very  low  velocities. 


Kinematic  Relationship  between  Pitch  and  Motor 
Shaft  Angular  Velocities 


Figure  3.16. 
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2 .  Belt  compliance  and  torsional  deflections  of  the 
transmission,  backlash  in  the  motor  gearbox,  fric¬ 
tion  at  the  motor  shaft  and  damping  at  the  pitch 
load  shaft  are  assiimed  negligible. 

3 .  The  end-effector  mass  is  assumed  to  be  concentrated 
at  a  single  point. 

The  conceptual  model  of  the  end— effector  depicting  the 
angular  displacements,  system  parameters  and  external  forces 
acting  on  the  system  is  shown  in  Figure  3.17.  The  eguation 
of  motion  of  the  end-effector  pitch  rotation,  derived  in 
Appendix  A,  is  given  by 


j-*e  +i>0  +  n^j.asin0-n^j.'^cose  -  t 


(3.3) 


where  J  is  the  equivalent  moment  of  inertia  of  the  end-effec¬ 
tor  reflected  at  the  pitch  axis  given  by 

J  -  J„nl  .  (3.4) 


The  total  weight  F/j.  of  the  end-effector  acts  through  the 

center  of  gravity  whose  coordinates  are  a  and  b  respectively. 
The  equivalent  damping,  D,  at  the  pitch  axis  is  given  by 

D-D„nJ(-p)2  ^  (3.5) 


The  reflected  torque,  x,  at  the  axis  of  rotation  is  given  by 


Figure  3.17.  Conceptualization  of  End-Effector  Pitch  Motion 
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T  -  (3.6) 

where  is  the  torque  generated  by  the  motor  and  rip  is  the 

transmission  ratio  of  the  planetary  gearhead. 

The  end-effector  parameter  values  are  listed  in  Table  I, 
and  their  computation  given  in  Appendix  B.  Figure  3.18  shows 
the  simulation  block  diagram  of  Equation  (3.3),  which  is  non¬ 
linear  due  to  the  presence  of  the  sine  and  cosine  terms. 
Linearization  of  Equation  (3.3)  about  the  equilibrium  posi¬ 
tion  of  the  end-effector,  0^  gives 

•.•i  .*A  (3.7) 

i70  +dQ+  (Wj.acosQ ^+Wj±>3inB ^)B  -  t  . 

The  displacement  of  the  end-effector  in  the  equilibrium 
position  is  shown  in  Figure  3.19.  The  transfer  function  of 
the  linearized  end-effector  dynamics  is  given  by 

Q  (g)  _  _ ’ i _  (3.8) 

f„(s)  S2  +  70.5S+18.1 

The  input  to  the  open  loop  model  of  the  end-effector  is  the 
torque  applied  by  the  pitch  motor  and  the  output  is  the  pitch 
displacement  of  the  end-effector.  The  roots  of  the  charac¬ 
teristic  equation  of  Equation  (3.8)  are 

Si  -  7  0.25 
Sj  -  0.25  . 
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Figure  3.19.  End-Effector  Equilibrivm  Position 
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Since  one  of  the  roots  (s^)  lies  far  to  the  left  of  the 
imaginary  axis  in  the  s-plane,  the  end-effector  dynamics  is 
dominated  by  the  slower  root  ( Sj )  •  system  can  then  be 
analyzed  as  a  first  order  system  whose  transfer  function  can 
be  approximated  by 

e(s)  _  8.75 

f^(s)  "  (4.0S+1) 

The  time  constant  of  this  first  order  approximate  system  is 
4 . 0  seconds . 

The  linearized  simulation  block  diagram  of  the  end- 
effector  system  is  shown  in  Figure  3.20.  A  pulse  torque 
input  is  applied  to  the  system.  The  width  of  the  input  pulse 
is  kept  constant  at  0.1  seconds  while  the  amplitude  of  the 
pulse  is  varied  for  different  simulation  runs.  Simulations 
are  carried  out  with  the  end-effector  initially  at  its  equi¬ 
librium  position.  The  response  of  the  non-linear  and  linea¬ 
rized  end-effector  dynamic  equations  to  a  pulse  torque  input 
with  an  amplitude  of  0.4  in-lb  is  shown  in  Figure  3.21(a). 
The  system  requires  approximately  20  seconds  to  come  to  rest 
because  of  the  long  time  constant. 

For  torque  inputs  with  pulse  amplitude  less  than  0.4  in¬ 
lbs,  resulting  in  approximately  45  degrees  angular  displace¬ 
ment  from  its  equilibrium  position,  the  two  response  curves 
are  similar,  confirming  that  the  non-linear  model  of  the  end- 
effector  can  be  approximated  by  the  linearized  model.  At 
greater  torque  input  levels  (>1.0  in-lb),  the  response  of  the 


Figure  3.20. 


Simulation  Block  Diagram  of  Linearized  Pitch 
Motion  Dynamic  Equation 
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linearized  system  differs  significantly  from  the  non-linear 
model  of  the  end-effector  as  seen  from  Figure  3.21(b). 

Design  Summary 

The  mechanical  component  design  of  the  end-effector  was 
accomplished  using  CADKEY,  a  three  dimensional  computer  aided 
design  and  drafting  package.  Figure  3.22  shows  the  design  of 
the  end-effector  in  three  dimensional  form.  The  end-effector 
was  fabricated  using  6061T  alximinum  to  minimize  its  weight. 
The  design  weight  of  the  end-effector  was  estimated  to  be 
less  than  10  pounds.  A  camera  was  mounted  on  the  end-effec¬ 
tor  to  provide  visual  feedback  of  the  turning  and  pressing 
processes.  Figure  3.23  shows  the  end— effector  mounted  on  the 


AdeptOne  robot. 


Figure  3.22.  End-Effector  Design  Configuration 


Figure  3.23.  End-Effector  Mounted  on  XdeptOne  Robot 


CHAPTER  IV 


PERFORMANCE  EVALUATION 

The  pitch  motion  of  the  end-effector  is  controlled 
through  a  closed  loop  control  system.  The  controller  gains 
were  determined  analytically  after  modelling  individual  sys¬ 
tem  components.  Non-linearities  present  in  the  system  were 
not  investigated.  The  analysis  results  were  verified  by 
digital  computer  simulation  of  the  modelled  control  system, 
and  by  observing  the  experimental  response  of  the  actual 
system . 

The  lateral  gripper  motion  is  actuated  by  a  step  motor 
operating  in  an  open  loop  mode.  The  command  velocity  and 
acceleration  values  that  provide  the  fastest  gripper  trans¬ 
lation  without  causing  the  step  motor  to  loose  steps  must  be 
determined.  This  requirement  is  accomplished  using  an  ex¬ 
perimental  procedure. 

Experimental  runs  were  conducted  involving  the  manipula¬ 
tion  of  a  shirt  collar  using  the  developed  end-effector.  The 
success  of  the  demonstrations  confirm  the  validity  of  the 
end-effector  design  concepts. 

Pitch  Motion  Control  System 
Analysis  and  Testing 

Analysis 

The  end-effector  pitch  motion  is  implemented  through  a 
closed  loop  control  system.  The  open-loop  dynamics  of  the 
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pitch  motion  was  developed  in  the  previous  chapter.  The 
dynamic  equation  of  pitch  motion  was  linearized  and  its 
response  to  a  pulse  torque  input  studied.  The  response  of 
the  linearized  model  was  shown  to  closely  resemble  the  non¬ 
linear  model  response  for  the  same  input  provided  the  pitch 
displacement  was  less  than  45  degrees. 

The  following  control  system  criteria  were  specified  to 
obtain  satisfactory  end-effector  pitch  motion  performance 
during  manipulation  operations: 

1.  The  transient  response  of  the  system  must  be  crit¬ 
ically  damped. 

2.  Steady  state  position  error  is  to  be  less  than 

0.1%. 

The  block  diagram  of  the  pitch  motion  control  system  is 
shown  in  Figure  4.1.  The  following  assumptions  and  approx¬ 
imations  were  made  in  the  analysis  of  the  control  system: 

1.  Saturation  effects  in  the  system  are  neglected. 

2.  The  DCX  servo  controller  is  modelled  in  the  con¬ 
tinuous  time  domain  since  the  sampling  time  of  the 
controller  is  extremely  small  (340  microseconds) . 

3.  The  dc  servo  motor  and  servo  amplifier  are  modelled 
as  static  elements  i.e.,  the  electrical  power  am¬ 
plifier  dynamics  are  fast  compared  to  the  mechani¬ 
cal  system  dynamics. 

Initially,  a  proportional  controller  with  a  gain  Kp  is 
used  in  the  control  system.  The  closed-loop  transfer  func¬ 
tion  of  the  system  is  given  by 


Figure  4.1.  Pitch  Motion  Control  System  Block  Diagram 
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e  (S) _ 7 .3SKp _  ^4 

6^(5)  s2  +  7o.54s+  (18.07 +7 .35iCp) 

Where  0  and  0,  are  the  actual  and  desired  end-effector 

displacements  respectively.  The  characteristic  equation  is 
given  by 

s2+7  0.54s+  (18.07+7.35Ji:p)  -0  ,  (4.2) 

and  is  of  the  form 

s2  +  2Cc«)pS  +  o>p  -  0  ,  (4.3) 

where  C  and  («)„  are  the  damping  ratio  and  natural  frequency  of 

the  system  respectively.  The  value  of  the  system  natural 
frequency  for  the  system  to  be  critically  damped  (C  ■  1-0)  is 
determined  as 

o)p  -  35.27  {radians/ second)  (4.4) 

or  Qp  -  5.6  {Hertz)  . 

The  value  of  Kp  for  critical  damping  was  determined  to  be 

Kp-  166.7  {volts/ radian)  .  (4.5) 

The  loop  gain,  defined  as  the  product  of  the  steady  state 
gains  of  the  transfer  functions  of  the  individual  loop  ele¬ 
ments,  was  determined  for  the  system  shown  in  Figure  4.1  to 
be 
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(Loop  Gain)  -  67.84  (radians/ zadian)  .  (4.6) 

The  input  to  the  system  shown  in  Figure  4.1  is  the 
desired  pitch  displacement  However,  in  the  actual  sys¬ 

tem,  the  input  to  the  DCX  controller  commands  the  angular 
rotation  of  the  servo  motor,  e„.  The  command  to  the  motor  is 

given  in  terms  of  the  pulses  of  the  encoder  mounted  at  the 
motor  shaft.  The  controller  then  computes  the  error  between 
the  desired  and  actual  encoder  count.  This  error  is  convert¬ 
ed  to  an  analog  voltage  by  a  digital-to-analog  (D/A)  convert¬ 
er  which  then  outputs  the  voltage  to  the  servo  amplifier. 
The  block  diagram  of  the  control  system,  modified  to  include 
the  encoder  and  D/A  converter  gains  is  shown  in  Figure  4.2. 
The  values  of  the  parameters  are  listed  in  Table  II. 

The  loop  gain  of  the  actual  system  was  determined  to  be 
(Loop  Gain)  digital- (counts/ count)  (4.7) 

Since  the  loop  gains  given  by  Equations  (4.6)  and  (4.7)  are 
non-dimensional  and  for  the  same  physical  system,  they  can  be 
equated  to  solve  for  the  equivalent  computer  control  gain 
^(digital)*  This  gain  value  is  used  in  the  DCX  servo  control¬ 
ler.  The  value  of  for  critical  damping  was  deter¬ 

mined  to  be 

^pidigital)  “  1-023  (4.8) 

-1.0  (counts/ count) 
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Figure  4.2.  Actual  System  Block  Diagram 


Table  II.  Actual  Control  System  Parameters 


Symbol 

Quantity 

Value 

Units 

Ka 

Amplifier 

Gain 

0.1 

amperes/ 

volt 

Kt 

Motor  Torque 
Constant 

0.465 

in-lb/ 

ampere 

Kda 

D/A  Converter 
Gain 

0.00488 

volts/count 

n„R/r 

Gear  Ratio 

105.0 

- 

Ke 

Encoder  Gain 

318.0 

counts/ 

radian 
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Experimental  Evaluation 

The  analysis  developed  in  the  previous  section  was  veri¬ 
fied  by  studying  the  response  of  the  modelled  control  system 
to  step  position  commands.  The  simulations  used  PC-MATLAB,  a 
mathematical  and  control  systems  analysis  software  package. 
The  actual  system  response  was  obtained  by  reading  the  encod¬ 
er  counts  and  writing  this  data  to  a  file.  The  file  was 
post-processed  using  MATLAB  and  the  data  points  plotted  as  a 
function  of  time.  The  simulated  and  actual  system  responses 
were  plotted  on  the  same  graph  for  comparison.  The  tests  are 
carried  out  for  small  pitch  displacements  about  the  equilib¬ 
rium  position  of  the  end-effector  to  minimize  the  effects  of 
non-linearities. 

The  response  of  the  system  to  a  small  step  command  of 
1.25  degrees  is  shown  in  Figure  4.3.  The  differences  between 
the  simulated  and  experimental  responses  are  possibly  due  to 
differences  between  the  estimated  and  actual  end-effector 
parameters.  The  negligible  overshoot  and  small  steady  state 
error  (between  1  and  2  encoder  counts)  shown  by  the  experi¬ 
mental  response  indicates  that  a  proportional  controller  is 
adequate  to  control  the  position  of  the  end-effector  axis. 
Different  gains  and  step  commands  were  applied  to  the  system 
to  study  the  validity  of  the  linear  pitch  control  system 
model . 

As  the  step  size  is  increased  for  the  same  value  of 
proportional  gain,  the  experimental  response  lags  the  simu¬ 
lated  response  as  shown  in  Figure  4.4.  The  dynamic  behavior 


Solid  Line;  Actual  System  Response 
Dotted  Line:  Linear  Model  Response 
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indicates  that  the  actual  system  may  be  ' saturated The  phe¬ 
nomenon  of  saturation,  represented  in  the  system  shovm  in 
Figure  4.5,  occurs  in  physical  systems  primarily  due  to  the 
limited  dynamic  range  of  actuators  and  amplifiers.  Satu¬ 
ration  in  the  end-effector  system  could  also  have  occurred 
due  to  the  limited  word  length  (12  bits)  of  the  D/A  converter 
in  the  DCX  board. 

A  large  reference  input  to  the  system  will  cause  the 
actuator  to  saturate  at  u^^.  Even  though  the  error,  e,  keeps 
increasing,  the  input  to  the  plant  u  -  ,  remains  constant. 

Due  to  the  reduced  control  effort,  the  output  of  the  plant 
increases  more  slowly  than  if  actuator  saturation  were  not 
present.  Hence,  the  output  of  the  actual  system  shown  in 
Figure  4.4  is  slower  than  the  response  of  the  linear  system 
in  which  the  effects  of  saturation  are  not  modeled. 

As  shown  in  Figure  4.6,  when  the  proportional  gain  is 
increased  to  20.0,  the  effect  of  backlash  present  in  the 
system  becomes  evident.  A  limit  cycle  is  a  phenomenon  of 
self-sustained  oscillations  that  occurs  in  a  control  system 
in  the  presence  of  non-linearitities.  A  limit  cycle  could 
occur  in  a  servomechanism  under  the  following  conditions: 

1.  The  magnitude  of  the  command  input  is  comparable  to 
the  backlash  present  in  the  system.  In  Figure  4.6, 
the  peak-to-peak  amplitude  of  the  oscillations 
represents  the  magnitude  of  backlash  present  in  the 
planetary  gearhead.  The  comparable  magnitudes  of 
the  backlash  (0.5  degrees)  and  the  command  input 
(1.25  degrees)  could  have  caused  the  limit-cycle  to 
be  excited. 


Presence  of  Saturation  Non-Linearity  in  a  Con¬ 
trol  System 


Figure  4.5. 


KP  =  20.00  COUNTS/ COUNT 


Solid  Line:  Actual  System  Response 
Dotted  Line:  Linear  Model  Response 
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2.  The  system  damping  constant  is  less  than  0.29. 
Lauer  et  al.[19]  show  that  a  servo  system  will 
undergo  sustained  oscillations  of  constant  magni¬ 
tude  provided  that  the  damping  constant,  C,  is  less 
than  0.29.  When  K.  is  20.0  counts/ count,  the  damp¬ 
ing  constant  of  the  end-effector  system  is  equal  to 
0.23,  causing  the  system  to  limit  cycle  in  the 
presence  of  backlash. 

3 .  Material  properties  of  the  gear  elements  such  as 
elasticity  and  resilience  cause  the  impacts  between 
gear  teeth  to  self-sustain.  Under  suitable  condi¬ 
tions,  impacts  of  mating  gear  teeth  could  set  up 
oscillations  in  the  system  that  could  lead  to  the 
system  entering  into  a  limit  cycle. 

Limit  cycling  causes  deterioration  of  the  mechanical 
components  and  affects  the  performance  of  the  end-effector. 
The  non-linearities  mentioned  above  and  other  unmodelled  end- 
effector  dynamics  such  as  belt  and  torsional  compliance, 
motor  and  amplifier  dynamics,  and  sampling  time  of  the  DCX 
servo  control  module,  must  be  considered  to  understand  their 
influence  on  system  dynamic  performance. 

Although  the  end-effector  curves  show  steady  state 
errors  of  less  than  0.005  degrees  (1-2  encoder  counts),  these 
graphs  depict  the  positioning  accuracy  of  the  motor  shaft, 
not  the  pitch  axis.  Backlash  present  in  the  planetary  gear- 
head  is  not  sensed  by  the  encoder  which  is  mounted  directly 
on  the  motor  shaft.  The  backlash  is  of  the  order  of  0.5 
degrees  which  yields  an  error  of  0.1  inches  at  the  gripper 
jaws. 


T.atf»ra1  Gripoer  Motion  Implementation 
and  Performance 


The  lateral  gripper  motion  is  actuated  by  a  stepper 
motor  in  an  open  loop  control  system.  The  only  step  motor 
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parameters  that  need  to  be  adjusted  are  the  pull-in  velocity 
or  the  velocity  with  which  the  motor  can  start  instan¬ 
taneously  without  loosing  steps,  the  maximum  velocity  and 
maximum  acceleration.  Based  on  these  parameters,  the  step 
motor  controller  generates  pulses  at  a  rate  corresponding  to 
a  defined  trapezoidal  velocity  profile.  Programming  veloci¬ 
ties  and  accelerations  higher  than  that  achievable  by  the 
system  will  cause  the  step  motor  to  loose  steps,  thereby 
loosing  positional  information. 

Determination  of  the  velocities  and  accelerations  that 
result  in  the  fastest  motion  was  accomplished  experimentally. 
A  linear  potentiometer  was  attached  to  one  of  the  ball  nuts 
which  moves  the  grippers  laterally  so  that  displacement  of 
the  gripper  could  be  measured.  The  output  of  the  potentiome¬ 
ter  was  read  through  a  12-bit  A/D  converter  on  a  Data  Trans¬ 
lation  data  acquisition  board.  The  digital  data  was  normal¬ 
ized  and  plotted  against  time  using  MATLAB.  The  fastest 
system  response  with  acceptable  steady  state  error  of  0.05 
inches  is  shown  in  Figure  4.7.  The  gripper  jaws  translate  at 
a  maximum  velocity  of  3  inches/second .  At  high  velocities, 
the  grippers  tend  to  vibrate  due  to  the  presence  of  clearanc¬ 
es  in  the  ball  nuts.  The  amplitude  of  vibrations  can  be 
reduced  by  providing  extra  bearing  support  to  the  grippers. 

Collar  Handling  Demonstration 

The  end-effector  design  concepts  were  tested  by  demon¬ 
strating  the  ability  of  the  end-effector  to  acquire  a  collar, 
transport  it  to  the  turning  machine,  and  unload  it  from  the 
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Step  Motor  Response  Measured  with  Linear  Po 
tentiometer 


Figure  4.7. 
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turning  machine  after  the  collar  had  been  turned.  The  demon¬ 
stration  provided  a  qualitative  measure  of  the  performance  of 
the  end-effector  design  implementation. 

At  the  beginning  of  the  demonstration,  the  end-effector 
performs  a  motion  sequence  that  initializes  the  pitch  motion. 
The  end-effector  does  not  at  present  include  sensors  which 
indicate  when  the  pitch  motion  has  reached  a  particular 
position.  The  homing  sequence  is  implemented  by  programming 
the  pitch  motor  to  move  slowly  in  one  particular  direction 
until  a  compliant  hard  stop  is  encountered.  During  this 
motion  the  encoder  count  is  continuously  monitored.  When  the 
end-effector  encounters  the  hard  stop,  the  encoder  count  will 
remain  the  same,  indicating  that  the  limit  of  pitch  motion 
travel  is  reached.  The  motor  is  commanded  to  move  a  fixed 
number  of  encoder  counts  from  this  hard  stop  until  the  grip¬ 
pers  are  horizontal.  The  pitch  angle  at  this  end-effector 
configuration  is  defined  as  the  home  position.  The  position 
of  the  grippers  relative  to  one  another  during  system  power- 
up  is  initialized  manually  because  of  the  absence  of  sensors 
to  indicate  when  a  particular  position  has  been  reached.  The 
procedure  adopted  to  home  the  pitch  motion  cannot  be  employed 
to  initialize  the  position  of  the  grippers  since  no  position 
feedback  device  exists. 

The  demonstration  involved  the  processing  of  a  military 
shirt  collar.  The  size  of  the  collar  is  15  inches  measured 
along  the  open  pocket.  Once  the  end-effector  has  been  ini¬ 
tialized,  the  two  grippers  move  apart  until  the  grippers  are 
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situated  about  12  inches  from  one  another.  The  collar  was 
manually  loaded  on  the  end-effector  with  the  individual  plies 
of  the  collar  separated. 

The  grippers  are  actuated  to  grasp  the  top  ply  of  the 
collar.  As  illustrated  in  Figure  4.8,  the  lower  ply  is 
separated  from  the  grasped  ply  due  to  gravity.  The  robot 
transports  the  collar  to  the  turning  machine.  The  end-ef¬ 
fector  simultaneously  performs  a  pitch  motion  to  increase  the 
opening  between  the  collar  plies.  The  increased  opening 
between  the  collar  plies  enables^  the  collar  to  be  loaded  more 
reliably  over  the  clippers  of  the  turning  machine.  Figure 
4.9  shows  the  end-effector  loading  the  collar  on  the  turning 
machine.  The  turning  machine  clippers  swivel  out  until  the 
collar  points  are  encountered.  When  the  clippers  encounter 
the  collar  tips,  considerable  force  is  applied  to  the  collar 
points  possibly  causing  the  fabric  to  slip  from  the  grippers 
of  the  end-effector.  However,  in  about  25  runs  of  the  dem¬ 
onstration,  the  fabric  has  slipped  from  the  gripping  surface 
only  once.  This  fact  confirms  the  utility  of  using  pinch 
grippers  to  grasp  the  fabric  for  this  application. 

The  correct  loading  of  the  collar  on  the  turning  machine 
validates  other  end-effector  design  concepts.  The  demonstra¬ 
tion  runs  showed  that  the  end-effector  was  uniformly  success¬ 
ful  in  loading  collars  in  such  a  way  that  the  two  collar 
plies  enclose  both  turning  machine  clippers.  The  concept  of 
using  gravitational  force  to  separate  the  collar  plies  is 
valid.  However,  for  apparel  processing  operations  which  are 
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Turning  Machine 
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carried  out  in  a  vertical  plane  as  opposed  to  a  horizontal 
one,  a  method  other  than  gravity  will  have  to  be  employed. 
The  proper  loading  of  the  collar  points  on  the  clippers  also 
shows  that  gripping  the  collar  at  two  locations  is  sufficient 
to  ensure  that  fabric  drape  is  controllable  at  the  collar 
points. 

After  the  collar  has  been  loaded,  the  grippers  release 
the  collar  and  the  end-effector  moves  away  from  the  turning 
machine.  Following  the  turning  operation,  the  collar  is 
supported  by  the  turning  machine  at  its  two  tips.  The  end- 
effector  must  translate  the  grippers  closer  together  during 
the  unloading  operation  to  prevent  collisions  with  turning 
machine  components.  The  grippers  are  aligned  with  the  top 
ply  of  the  collar  via  a  pitch  motion.  The  absence  of  tension 
on  the  top  ply  of  the  collar  as  it  is  supported  on  the  turn¬ 
ing  machine  makes  it  difficult  to  predict  the  position  of  the 
ply  edge.  During  the  demonstrations,  the  end-effector  fre¬ 
quently  would  grasp  the  ply  edge  at  only  one  location  while 
the  other  gripper  failed  to  grasp  any  part  of  the  collar. 
The  problem  can  be  corrected  by  introducing  a  mechanism  in 
the  turning  machine  that  stretches  the  top  ply  of  the  collar 
after  it  has  been  turned. 

The  end-effector  upon  acquiring  the  turned  collar  de¬ 
posits  it  at  a  specified  location.  The  current  collar  pro¬ 
cessing  workstation  does  not  include  the  pressing  device. 
After  the  pressing  device  is  integrated  into  the  collar 
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processing  workstation,  the  end-effector  will  have  to  manip¬ 
ulate  the  collar  to  load  it  on  the  pressing  device. 

End-effector  motion  trajectories  during  the  demonstra¬ 
tion  were  controlled  by  software  routines  written  in  the  'C 
programming  language.  All  end-effector  motions  were  coordi¬ 
nated  with  the  robot  and  turning  machine  motions,  showing 
that  the  end-effector  can  be  integrated  with  the  hierarchical 
control  scheme  for  the  robot-assisted  collar  processing 
workstation.  This  evaluation  procedure  has  showed  that  the 
end-effector  is  capable  of  manipulating  a  multiple-ply  appar¬ 
el  component  (in  this  case,  a  shirt  collar)  in  three  dimen¬ 
sional  space. 


CHAPTER  V 


CONCLUSIONS  AND  RECOMMENDATIONS 
Conclusions 

An  end-effector  capable  of  manipulating  multiple-ply 
apparel  workpieces  in  three  dimensional  space  has  been  de¬ 
veloped.  The  mechanical  design  concepts  for  the  end-effector 
vere  developed  after  visual  observation  of  manipulation  of  an 
apparel  shirt  collar  by  a  human  operator.  Implementation  of 
these  concepts  for  the  particular  task  of  robot  handling  of 
shirt  collars  yielded  a  two  degree-of- freedom  (DOF)  end- 
effector.  The  end-effector  employs  two  pinch  grippers  to 
grasp  the  unfused  collar  ply*  The  collar  plies  are  separated 
from  one  another  by  gravitational  force.  A  translatory 
motion  of  the  gripper  jaws  enables  the  end— effector  to  ten¬ 
sion  the  grasped  ply  and  to  handle  different  workpiece  sizes. 
A  pitch  motion  on  the  end-effector  orients  the  grippers 
during  loading  and  unloading  operations  on  the  turning  and 
pressing  machines. 

The  grippers  are  actuated  pneumatically  providing  a 
maximum  opening  of  a  half  inch  between  the  gripper  jaws. 
This  opening  is  sufficient  for  acquiring  the  collar  from  the 
destacking  and  turning  machines.  The  motion  that  varies  the 
distance  between  the  grippers  is  actuated  by  a  stepper  motor. 
The  gripper  translation  mechanism  was  designed  so  that  inter¬ 
ferences  with  the  robot  workspace  is  minimized.  The  velocity 
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and  acceleration  parameters  of  the  stepper  motor  were  deter¬ 
mined  by  experimentally  obtaining  the  response  of  the  lateral 
gripper  motion.  The  range  of  lateral  gripper  motion  is  five 
to  fourteen  inches  at  a  maximum  velocity  of  six  inches/sec¬ 
ond. 

The  pitch  motion  of  the  end-effector  incorporates  a 
novel  design  to  minimize  the  peak  torque  and  size  required  by 
the  motor  drive.  The  DC  servo  motor,  which  actuates  the 
motion,  rotates  about  the  pitch  axis  to  act  as  a  counterbal¬ 
ance  to  the  rest  of  the  end-effector  mass.  The  unique  fea¬ 
ture  of  the  design  is  that  counterbalancing  is  achieved  with 
an  active  end-effector  component  (the  DC  servo  motor)  as 
opposed  to  using  a  passive  mass  that  does  not  contribute 
towards  the  functioning  of  the  end-effector.  Wider  use  of 
such  counterbalancing  mechanisms  in  robots  and  end-effectors 
could  result  in  more  efficient  designs. 

The  design  and  evaluation  procedure  for  the  pitch  motion 
control  system  indicated  that  a  proportional  controller  is 
adequate  for  satisfying  the  performance  specifications  of 
zero  overshoot  and  low  steady  state  error  (less  than  0.1% 
which  corresponds  to  1-2  encoder  counts  for  a  1.25  degrees 
position  command  step) .  Deviations  from  the  expected  linear 
behavior  of  the  end-effector  for  large  motion  commands  and 
large  controller  gains  were  observed,  indicating  that  non- 
linearities  such  as  motor  drive  saturation  and  gearbox  back¬ 
lash  need  to  be  modeled  to  more  accurately  predict  the  dy¬ 
namic  behavior  of  the  end-effector.  The  pitch  motion  has  a 


110 


range  of  travel  of  plus  and  minus  90  degrees  from  the  posi¬ 
tion  when  the  grippers  are  horizontal  and  achieves  a  maximum 
velocity  of  90  degrees/ second. 

The  performance  of  the  end-effector  system  was  demon¬ 
strated  by  carrying  out  actual  collar  manipulation  tasks 
within  a  robot-assisted  collar  processing  workstation.  The 
end-effector  was  able  to  successfully  load  the  collar  on  the 
turning  machine.  However,  the  task  of  collar  acquisition 
from  the  turning  machine  was  not  reliable  since  the  ply  to  be 
grasped  was  not  under  tension.  Modifications  in  the  design 
of  the  turning  machine  which  tension  the  collar  ply  after 
turning  will  enable  the  end-effector  to  acquire  the  collar 
more  reliably.  The  demonstration  showed  the  feasibility  of 
accomplishing  three  dimensional  apparel  workpiece  manipula¬ 
tion  with  a  robot  end-effector. 

Recommendations 
Analysis  of  Fabric  Behavior 

The  design  of  the  end-effector  has  been  based  on  obser¬ 
vation  of  a  hviman  operator  handling  fabric  workpieces. 
Limited  research  has  been  conducted  to  understand  and  predict 
fabric  behavior.  Present  research  efforts  have  concentrated 
on  modeling  the  behavior  of  single-ply  fabric  components 
under  limited  loads  and  boundary  conditions.  As  more  results 
become  available  of  multiple-ply  fabric  component  behavior, 
techniques  for  their  handling  by  automated  devices  can  be 
developed  analytically.  Robot  end-effector  designs  based  on 
these  analytical  methods  will  be  more  reliable  and  optimum 
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with  respect  to  the  number  of  degrees-of-freedom  and  sensors 
required. 


Improvements  in  Mechanical  Design 

The  following  improvements  are  suggested  for  the  mechan¬ 
ical  design  of  the  end-effector: 

1.  The  planetary  gearhead  which  reduces  speed  between 
the  motor  and  the  pitch  axis  introduces  errors  in 
the  position  of  the  grippers  due  to  presence  of 
backlash  in  the  gear  system.  This  backlash  is  not 
sensed  by  the  encoder  that  serves  as  the  position 
transducer  since  it  is  mounted  at  the  motor  shaft. 
Better  positional  accuracy  would  result  if  the 
encoder  were  to  be  mounted  at  the  pitch  axis;  how¬ 
ever,  the  system  would  tend  to  hunt  for  the  desired 
position  due  to  inclusion  of  backlash  in  the  feed¬ 
back  loop.  A  solution  to  the  problem  could  be  to 
use  a  dual-loop  control  system.  Encoders  could  be 
mounted  both  at  the  motor  axis  and  at  the  pitch 
axis.  During  a  motion,  the  motor  position  is  fed 
back  to  the  controller.  Once  the  motion  is  com¬ 
pleted,  the  position  of  the  pitch  displacement  is 
fed  back.  The  backlash  error  is  determined  and  the 
motor  is  commanded  to  move  to  eliminate  this  error. 


2.  Although  the  implementation  of  the  counterbalancing 
Concept  has  resulted  in  reduction  of  peak  torque  by 
the  actuator,  the  center  of  gravity  of  the  end- 
effector  is  offset  from  the  pivot  axis  by  approxi¬ 
mately  1.5  inches.  The  design  of  the  end-effector 
can  be  optimized  so  that  the  center  of  gravity 
coincides  exactly  with  the  pitch  axis.  An  end- 
effector  design  with  the  center  of  gravity  coincid¬ 
ing  with  its  pitch  axis  is  perfectly  balanced.  A 
balanced  end-effector  does  not  require  the  DC  servo 
motor  to  overcome  a  static  imbalance  torque;  the 
motor  would  have  to  overcome  only  the  inertia  and 
damping  of  the  system. 

Clearance  in  the  ball  nuts  results  in  vibration  of 
the  grippers  as  they  translate.  The  design  of  the 
mechanism  can  be  improved  by  providing  extra  linear 
bearing  supports  to  the  carriages  which  transport 
the  grippers  laterally. 


3. 
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4 .  The  normal  force  exerted  by  the  grippers  on  the 
grasped  apparel  workpiece  can  be  improved  by  using 
a  gripping  surface  with  a  higher  coefficient  of 
friction. 

Refinement  in  Pitch  Control  System  Analysis 

Analysis  of  the  pitch  motion  control  system  revealed 
presence  of  non-linearities  such  as  actuator  saturation,  sta¬ 
tic  friction  and  backlash  in  the  gearbox.  The  model  of  the 
end-effector  developed  in  this  thesis  is  linear.  This  model 
needs  to  be  extended  to  include  the  effects  of  non-linear¬ 
ities  for  more  accurate  prediction  of  the  performance  of  the 
end-effector  to  different  motion  commands  and  controller 
.  structure . 

Addition  of  Sensors 

The  reliability  of  fabric  handling  operations  by  the 
end-effector  can  be  improved  by  providing  sensory  feedback  of 
the  state  of  the  apparel  workpiece.  Break-beam  sensors  can 
be  included  on  the  grippers  to  indicate  the  presence  of  the 
workpiece  between  the  gripper  j  aws .  Sensors  must  be  included 
which  determine  the  tension  on  the  grasped  ply.  Their  inclu¬ 
sion  will  determine  the  amount  of  lateral  gripper  motion 
required  to  stretch  the  grasped  ply  in  order  to  control 
fabric  drape  at  the  workpiece  edges. 


APPENDICES 


Appendix  A 

Kinematic  and  Dynamic  Analysis 
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An  analysis  was  conducted  to  determine  the  kinematic  and 
dynamic  equations  of  the  pitch  motion.  The  derivation  of  the 
equations  is  presented  in  this  Appendix. 

The  following  assumptions  are  made  in  the  analysis: 

1.  The  dynamics  of  the  robot  and  the  end-effector  are 
decoupled.  This  is  true  during  most  motion  tra¬ 
jectories  involving  simultaneous  end-effector  and 
robot  motion.  The  end-effector  executes  the  pitch 
motion  during  collar  loading  or  unloading  opera¬ 
tions  on  external  processing  devices,  during  which 
times  the  robot  links  are  either  stationary  or 
moving  at  low  velocities*. 

2.  Compliance  due  to  belt  extension  and  torsional 
deflection  of  the  transmission  shaft  is  assumed 
negligible. 

3.  Clearance  between  the  belt  and  sprocket  teeth,  and 
backlash  in  the  gearhead  is  neglected. 

4.  Friction  in  the  motor  and  gearhead  is  assumed  neg¬ 
ligible. 

5.  The  mass  of  the  end-effector  components  that  do  not 
rotate  about  the  motor  axis  is  assumed  to  be  con¬ 
centrated  at  a  single  point. 


Kinematic  Analysis 

The  kinematic  relationship  between  the  angular  rotation 
of  the  motor  shaft  relative  to  the  moving  axis  and  the  pitch 
displacement  is  shown  in  Figure  A.l.  The  dynamic  analysis 
requires  that  the  determination  of  the  kinematic  relationship 
between  the  absolute  angular  rotation  of  the  motor  shaft  and 
the  pitch  displacement  be  determined.  The  derivation  of  the 
kinematic  equations  follows  an  analysis  procedure  given  by 
Mabie  and  Ocvirk  [20]. 
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Figure  A.l.  Conceptualization  of  End-Effector  Kinematics 
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The  pitching  mass  of  the  end-effector  is  approximated  as 
a  link  3  that  pivots  about  fixed  point  O.  Pulley  2  is  cou¬ 
pled  to  the  motor  shaft  and  Pulley  1  is  fixed  so  that  it  does 
not  rotate  about  the  pitch  axis.  Initially,  consider  that 
the  mechanism  is  changed  in  such  a  way  that  link  3  is  fixed 
and  pulleys  1  and  2  are  free  to  rotate  about  their  respective 
axes.  This  results  in  a  normal  belt  drive,  where  the  kine¬ 
matic  relationship  is  given  by 


(A.l) 


where,  “i3  angular  velocities  of  pulleys  2 

* 

and  1  with  respect  to  the  link  3  respectively.  If  the  mecha¬ 
nism  is  now  inverted  back  to  its  original  configuration,  that 
is  link  3  is  free  to  rotate  and  pulley  1  is  non-rotating 
about  the  pitch  axis.  Equation  (A.l)  is  still  valid.  Howev¬ 
er,  we  are  interested  in  determining  the  angular  velocity, 
<1)31  of  link  3,  which  is  the  angular  velocity  of  the  pitch 

motion,  with  respect  to  the  stationary  pulley  1.  Since 
0)3^ - 0)33,  then  substituting  in  Equation  A.l  gives 


Equation  A. 2  describes  the  relationship  between  the  angular 
velocity  of  pulley  2  with  respect  to  the  rotating  link  3  and 
the  absolute  angular  velocity  of  link  3.  However,  for  the 
dynamic  analysis,  the  relationship  between  the  absolute 
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angular  velocities  of  the  pulley  2  and  link  3  is  of  more 
interest.  The  absolute  angular  velocity  of  pulley  2  is  given 

by 

“21  -  “23  “31  ' 


Where  Wji  is  the  absolute  angular  velocity  of  pulley  2. 
Dividing  Equation  A.  3  by  and  substituting  Equation  A.  2 

yields 

^21  _  _(_£_!)  (A. 4) 

“31  ^  ^ 


The  relationship  between  the  magnitudes 


of  the  veloci¬ 


ties,  «p(-|“2i|)  and  6(i“3il)  is  given  by 


±  - 
6 


“21 

1-^ 

“31 

r 

(A. 5) 


Since  in  this  particular  end-effector  design  implementation, 
R  >  r,  that  is  the  radius  of  the  stationary  pulley  is  greater 
than  the  radius  of  the  moving  pulley, 

(A. 6) 

r 

Therefore,  from  Equation  (A. 5),  we  get 
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^  ^  _  1  (A. 7) 

6  -T 


Interesting  observations  can  be  made  by  considering 

p 

three  different  possibilities. 

1.  When  R  >  r,  as  in  this  case,  the  moving  pulley 
appears  to  rotate  in  a  direction  opposite  to  that 
of  the  pitch  direction. 

2.  When  R  <  r,  the  moving  pulley  appears  to  be  rotat¬ 
ing  in  the  same  direction  as  the  pitch  motion. 

3.  When  R  =  r,  the  moving  pulley  has  zero  absolute 
angular  velocity  and  appears  to  translate  about  the 
pivot  point. 

Dynamic  Analysis 

The  end-effector  system  considered  for  the  analysis  of 
the  pitch  motion  consists  only  of  the  moving  elements.  All 
external  forces  and  torques  acting  on  the  system  are  shown  in 
Figure  A. 2.  Derivation  of  the  equation  is  first  accomplished 
using  the  principles  of  classical  mechanics.  The  correctness 
of  this  equation  is  verified  by  rederiving  the  equation  using 
Lagrange's  equations. 

The  end-effector  dynamic  equations  are  derived  by  con¬ 
sidering  the  free  body  diagram  of  two  s\ib-systems.  The  first 
sxib-system  considered  consists  of  bodies  that  rotate  relative 
to  the  motor  axis  and  include  the  motor  rotor,  gears  present 
in  the  planetary  gearhead  and  the  rotating  pulley.  The  mass 
of  this  sub-system  is  designated  as  uip.  The  second  sub-system 
consists  of  bodies  that  pivot  about  the  stationairy  shaft 
except  those  included  in  sub-system  1.  The  mass  of  sub- 


Figure  A. 2. 


Conceptualized  3— D  Model  of  End— Effector  for 
Dynamic  Analysis 
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system  2  is  designated  as  m^.  The  total  mass,  m^  of  the  end- 
effector  is 

m^-mp+mg  .  (A. 8) 

Derivation  Using  Newtonian  Mechanics 

The  free  body  diagram  of  the  moving  pulley  is  shown  in 
Figure  A.  3.  J„,  the  centroidal  moment  of  inertia  of  the  motor 

rotor  is  magnified  through  the  planetary  gearhead  with  a 
transmission  ratio  of  np.  Ip,  the  centroidal  moment  of  iner¬ 
tia  of  the  motor  rotor  reflected  at  the  gearhead  shaft  is 
Jn^np^.  Forces  acting  on  the  pulley  are  resolved  along  the  'n' 
and  't'  directions.  Summing  forces  along  the  positive  't' 
direction  defined  in  Figure  A.  3,  and  moments  about  point  C 
produces  the  following  equations: 

Sfl+^V’lina-TjSina+in^^ine  -  iDpS^  , 

-Mj.+ {Tj^-T2)r  -  .  (A. 10) 

The  formulas  for  sina  and  are  given  by 

sina  -  ^  ,  (A.  11) 

ae  -  je  .  (A.12) 

Substituting  for  from  Equation  A.  10,  sina  from 

Equation  A.  11  and  from  Equation  A.12  into  Equation  A. 9 
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yields  the  following  expression  for 

+  (-p-i) --y  (-J-1) -^p^sine  .  (A.  13) 

The  free  body  diagram  of  sub-system  2,  i.e.  the  end- 
effector  mass  that  does  not  contain  elements  rotating  about 
the  motor  axis,  is  shown  in  Figure  A. 4.  Considering  counter¬ 
clockwise  moments  to  be  positive  and  summing  about  point  O 
gives  the  following  equation: 

•  •  (A. 14 ) 

M^  + m^g (gcosB - psind)  - SqI  -  m^{p^  +  g^)Q  - 


Rearranging  the  terms  yields 


S^l  -  M^-m^ip^  +  g^)'Q  +in^{gcosB-psinQ)  . 


(A. 15) 


Multiplying  Equation  A. 13  by  1  and  substituting  for S^l 
into  Equation  A. 15  gives 


-  [J,(y-l)*  +  jn„(p^  +  g^) +njpi^]6 
*  sinB-m^gcosB  . 


(A. 16) 


The  coordinates  of  the  center  of  gravity  of  the  two-mass 
system  shown  in  Figure  A. 5  can  be  determined  as  follows: 

irigP  *  nipi-l) 


a  - 


flip  + 


(A. 17) 


and 


b  - 


m^g  *  /np(0) 

iHp  + 


(A. 18) 
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from  which  can  be  obtained 


mjp-mpl  -  m^a 

(A. 19) 

m^g  -  nijjb  . 

(A. 20) 

The  inertia  of  point  masses,  nip  and  m^  can  be  substituted  by 
the  equivalent  inertia  of  the  center  of  gravity  of  the  end- 
effector,  i.e., 

m^ip^  +  +b^)  .  (A. 21) 

Substituting  Equations  (A. 19),  (A. 20),  (A. 21)  into  Equation 

(A. 16)  gives  the  equation  of  motion  of  the  system 

M  —  •  [ J^(— -l)^+n75.(a^  +  i)^)  ]’6  +  P/j-3sin0- F/jjbcos0  .  (^*22) 
^  r  r 


Derivation  Using  Laaranaian  Method 

For  the  end-effector  system  under  consideration,  it  is 
convenient  to  choose  0  and  <p  as  the  generalized  coordinates, 
whose  motions  are  geometrically  constrained  according  to 
Equation  A. 7.  Lagrange's  equations  in  this  case  is 


(A. 23) 


where  j  is  the  number  of  generalized  coordinates  and  1  is  the 
number  of  constraint  equations.  S£  is  the  Lagrangian,  5j-'s 

are  the  generalized  coordinates,  S^'s  are  the  generalized 
forces,  Ij's  are  the  Lagrangian  multipliers  and  are 
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obtained  from  the  constraint  equations.  For  the  end-effector 
system,  j  =  2  and  1  =  1  and  the  generalized  coordinates  are 
given  by 


$1  -  0,  and 
$2  -  <P  • 


(A. 24) 


The  generalized  coordinates  are  related  by  constraint  equa¬ 
tions  of  the  form 

n 

j  +  aj  -  0  2-1,2, . ,m.  (A. 25) 

j-i 

The  constraint  equation  given  by  Equation  A. 7  can  be  rewrit¬ 
ten  as 

(J?-r)0-r(j>  -  0  .  (A. 26) 


Comparing  Equations  A. 25  and  A. 26,  and  noting  that  in  the 
present  case,  1=1,  the  following  expressions  can  be  ob¬ 
tained: 

a^e  -  J?-r, 

<A.27)  ^ 

a^^  -  -r,  and 
a^  -  0  . 


Lagrange's  equations  for  the  end-effector  system  are 


d  (  d^]_  aS£  .  w 


(A. 28) 


The  Lagrangian  is  given  by 

^  ~  T*-V  ,  (A.  30) 

where  T*  is  the  kinetic  energy  and  V  is  the  potential  energy 
of  the  system  and  are  expressed  as 

T*  -  Aj^<|,2  +  A;nr(a2+b2)62  ,  (A.  31) 

A  A 


V-  -mjg(.bs±nd  +  acosd)  .  (A. 32) 

Substituting  Equations  A.  31  and  A. 32  into  Equation  A.  30 
yields 

S£  -  —  J^<j)2  + -Ij72j.(a2+jb2)6^+7nrsr(bsin0  +  acos0)  .  (A. 33) 

2  2 

The  partial  derivatives  of  Equations  A. 28  and  A. 29  are  eval¬ 
uated  as  follows; 

-  in-.(a*+jb*) 0  ,  (A. 34) 


dg 

80 


-jnygrasinS  +  rjjSTjbcosS  , 


(A. 35) 
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^  .  J,*  ,  (A.  36) 

M  .  0  .  (A. 37) 

d<p 

The  generalized  forces  corresponding  to  a  particular  gener¬ 
alized  coordinate  are  determined  by  evaluating  the  work  done 
along  the  direction  of  the  coordinate  when  all  other  coordi¬ 
nates  are  constrained  to  remain  fixed.  The  generalized 
forces  corresponding  to  the  two  generalized  coordinates , 0 

and  <p  are 

2e  -  W,  . 


~  Mj.  .  (A. 39) 

Substituting  Equations  A. 27,  A. 34,  A. 35  and  A. 38  into 
Equation  A. 28  gives 

mj.{a^+b^)B+mjgasinQ-injgbco3B  -  iR-r)  X  .  (A. 40) 

Equations  A. 27,  A. 36,  A. 37  and  A. 39  are  substituted  into 
Equation  A. 29  to  give 

-  M^-rX  .  (A. 41) 


Substituting  for  X  from  Equation  A.  41  and  for  ^  from  Equation 
A. 26  into  Equation  A. 40  gives  the  equation  of  motion  for  the 


system 
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M  —  -  [J^(— -l)2+inr(a2  +  2>2)  ]6  +  Pi^Tasin0-P/j2x:os0  .  (A. 42) 
^  r  I 

Equations  A. 22  and  A. 42  derived  independently  by  New¬ 
tonian  mechanics  and  Lagrange's  equations  respectively  are 
identical ,  confirming  the  correctness  of  the  obtained  equa¬ 
tion  of  motion. 

the  torque  reflected  at  the  output  of  the  planetary 
gearhead  is  the  resultant  of  the  torque  generated  by  the 
motor  and  the  opposing  velocity  dependent  torque  due  to 
viscous  damping  present  in  the  motor.  is  given  by  the 

following  relationship: 

M,  -  ,  (A. 43) 

where,  is  the  torque  generated  by  the  motor  and  D^,  is  the 
viscous  damping  of  the  motor.  Substituting  the  expression 
for  into  Equation  A. 42  gives 

T„-jnp  -  [J^{-^-l)^+jnj.(a=*+b2)]0+£>„(-p)^nj0 

+  Ji^jasin0-J\7^^os0  .  (A.  44) 

Equation  A. 44  may  be  rewritten  as 

jB  +  +  W^asind -  Wjbcosd  -  t  ,  (A.  45) 

where  J  -  -1)^ +  +  b^)  is  the  equivalent  moment  of 

2  R  o 

inertia  of  the  end-effector  about  the  pitch  axis  andD  -  Djip{  —  )^ 
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is  the  effective  damping  at  the  pitch  axis,  and  t  -  is 


the  reflected  torque  at  the  axis  of  rotation. 

Linearization  of  the  Equation  of  Motion 

The  sine  and  cosine  terms  present  in  Equation  A. 45 
render  it  non-linear.  The  equation  is  linearized  so  as  to 
enable  the  application  of  standard  linear  systems  analysis 
techniques  to  the  end-effector.  Linearization  is  accomplis¬ 
hed  by  solving  for  the  equilibrium  position  of  the  end-ef¬ 
fector  and  obtaining  the  Taylor  series  expansion  about  the 
equilibrium  point.  Substituting  0^,  the  displacement  of  the 

end-effector  at  its  equilibrium  position  for  0  in  the  equa- 

•  •  t 

tion  of  motion,  and  noting  that  at  equilibrium,  0^  and  0^ 

are  both  equal  to  zero,  and  knowing  that  the  end-effector  is 
in  equilibrium  when  no  external  torques  are  applied  i.e.,!^ 

is  zero,  we  obtain  the  following  expression  to  determine  the 
equilibrium  position: 

F/3asin0-li^ji>cos0  -  0  .  (A. 46) 

The  equation  of  motion  is  linearized  about  the  end-effector 
equilibrium  position,  0,,.  The  Taylor  series  expansion  for 

sine  and  cose  are  given  by 
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sin6  -  sin0o+-^sin0  (0-0o)  + 
-  sindg+  (cosdj6  , 


COS0  -  COS0  +-^COS0  {0-0o)  + 

^  e„ 

-  cos0£,-  (sin0o)  6  . 


(A. 47) 


(A. 48) 


Equation  A. 45  can  be  rewritten  as 


iKO'o+O)  +  D(0j6)  +  H^ra[sin0o+ (cos0o)6] 
-fi^jjb[cos0o- (sin0o)0]  -  +  ^  . 


(A. 49) 


Noting  that  0^  and  are  equal  to  zero  and  substituting 

Equation  A. 46  into  Equation  A. 49  we  get  the  linearized  equa¬ 
tion  of  motion 


J0'  +150+  ((i^jacos0o+F/3jbsin0o)0  -  ^  • 


(A. 50) 


132 


Anpendix  B 

Detennination  of  Control  System  Parameters 

The  dynamic  equation  of  pitch  motion  given  by  Equation 
(A. 50)  can  be  rewritten  as 


+  [J^jacose^+J/jjbsinSo]  6  .  (B.l) 


The  transfer  function  between  0 ,  the  pitch  displacement 
and  the  torque  generated  by  the  DC  servo  motor  is  given 

by 

r,  R 

»  J2_ — 

e(g)  _ _  ^ ^ _  . 

f„(s)  [j-„(^-l)2nJ+m3.(a2  +  b2)]s2  (B-2) 

+  [IVjacos0o+ -  VjiJsinSp] 

The  motor  inertia  is  obtained  from  the  manufacturers 
catalog  as  -  5.97x10'®  lb- in-sec^ .  The  timing  belt  trans¬ 
mission  ratio,  —  is  numerically  equal  to  3.0.  The  planetary 

r 

gearhead  ratio  is  equal  to  35.0.  IVj.  is  the  estimated  design 

weight  of  the  end-effector  and  was  calculated  to  be  8.0  lbs. 
The  distance  of  the  center  of  gravity  of  the  end— effector 
from  the  pivot  was  experimentally  determined  to  be  1.5  inch¬ 
es.  The  equilibrium  position  of  the  end-effector,  0^,  was 

determined  to  be  60  degrees  in  the  direction  shown  in  Figure 
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A. 2.  a  and  b  were  calculated  to  be  0.75  inches  and  1.3 
inches  respectively.  The  equivalent  inertia  at  the  pitch 
axis,  J  is  given  by 

J-  J^(-^-l)^np+inj.{a^  +  b^) 

-  0.664  Ib-in-aec^  (B*3) 

The  motor  damping  constant,  Dj„,  can  be  approximately 
determined  using  the  formula 


where  Jj,,  is  the  motor  inertia  and  x  is  the  mechanical  time 

constant  of  the  motor.  To  obtain  a  more  accurate  estimate  of 
D^,  an  experimental  procedure  was  adopted. 

Under  steady  state  conditions,  i.e.,  when  the  load  is 
not  accelerating  or  decelerating,  the  motor  has  to  overcome 
only  velocity  related  opposing  torques.  Neglecting  Coulomb 
friction  and  damping  at  the  pitch  axis,  the  motor  torque  has 
to  overcome  the  motor  damping.  The  generated  motor  torque  is 
then  given  by 

.  (B.5) 

The  motor  torque,  can  be  determined  by  measuring  the  cur¬ 
rent,  parsing  through  the  armature  when  the  motor  is 

rotating  at  constant  velocity.  The  formula,  where 

JCj,  is  the  motor  torque  constant,  is  used  to  determine  the 
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torque  generated  by  the  motor.  The  speed,  o>„  of  the  motor  is 

measured  experimentally.  The  data  points  are  joined  using 
linear  interpolation.  The  slope  of  the  torque  versus  speed 
straight  line  shown  in  Figure  B.l  gives  the  motor  damping 
constant. 

(B.6)  Da  -  0 . 0697 oz- in-sec 
-  0. 00425 Jjb-in-sec  . 

The  equivalent  damping  of  the  end-effector,  D  is  given  by 

-  46 . 836i2>-in-sec  .  (B.7) 

* 

The  load  torque  term  is  given  by 

F/jasin0 o  +  W'li’COsB o  -  12  in-lb  .  (B.8) 

Substituting  the  values  obtained  from  Equations  (B.3), 
(B.7)  and  (B.8)  into  Equation  (B.2),  we  obtain  the  transfer 

function  between  6  and  to  be 

6(s)  .  _ 105.0 _ 

f  is)  '  0.6645^+46.8365+12.0 

jn '  * 

.  - 158^3 -  .  (B.9) 

5^+70.545+18.07 

In  order  to  control  the  position  of  the  pitch,  the  loop 
is  closed  as  shown  in  Figure  B.2.  The  motor  torque  constant 
is  obtained  from  the  manufacturers  catalog  as 

JiTj,-  0.465  .  (B.IO) 

^  ampere 


Pitch  Motion  Control  System  Block  Diagram 


137 


The  servo  amplifier  was  set  to  operate  in  the  torque  control 
mode  and  its  gain  adjusted  to  0.1  amperes/volt.  The  transfer 
function  between  0,  the  actual  pitch  displacement  and  0^,  the 

commanded  pitch  displacement  is  given  by 

0(g) _ ^  -  .  (B.ll) 

0c(g)  s2  +  70.54s+ (18.07 +7  .SSifp) 


The  block  diagram  of  the  control  system  that  includes 
the  D/A  converter  and  encoder  gains  is  shown  in  Figure  B.3. 
The  D/A  converter  on  the  servo  controller  module  of  the  DCX 
board  converts  a  12  bit  binary  number  into  a  voltage  level 
between  +10  volts  -10  volts.  The  gain  of  the  D/A  converter 
is  thus  given  by 


^DA 


20  volts 
■>12 


counts 
.  0.00488 

count 


(B.12) 


The  encoder  used  for  position  feedback  generates  500  pulses 
for  every  revolution  of  the  motor  shaft.  The  DCX  controller 
decodes  the  quadrature  output  from  the  encoder  to  increase 
the  resolution  of  the  encoder  by  a  factor  of  four.  The 
controller  is  thus  able  to  read  2000  counts  per  revolution  of 
the  motor  shaft.  Therefore,  the  encoder  gain  is  given  by 
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2000  counts 


27C 
-  318.31 


radians  (of  motor  shaft) 
counts 


radian 


(3.13) 


The  transfer  function  of  the  control  system  between  the 
actual  pitch  displacement,  8  (in  radians),  and  the  desired 
motor  displacement, 6^  (in  counts)  is  given  by 

0(s)  _  0.036Kp _ 

'  S2  +  70.54S+ (18. 07+1203. 21J:p) 


(B.14) 
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Appendix  C 

End-Effector  Hardware  Specifications 
Controller  Hardware 


Controller  Board 

Manufacturer:  Precision  Micro  Control  Corp. 

3555  Aero  Court 
San  Diego,  CA  92123 
(619)  565  1500 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number:  DCX 

Description:  Eight-Axis  Motion  Controller  Board 

Analog  Signal  Output  Module 

Manufacturer:  Precision  Micro  Control  Corp. 

3555  Aero  Court 
San  Diego,  CA  92123 
(619)  565  1500 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number:  DCX-MClOO 

Description:  Plug-in  module  for  controlling  DC  servo  motor 

for  pitch  motion  (inserted  into  axis  #  3  on 
DCX  mother  board) 

Stepper  Motor  Module 

Manufacturer:  Precision  Micro  Control  Corp. 

3555  Aero  Court 
San  Diego,  CA  92123 
(619)  565  1500 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number:  DCX-MC150 

Description:  Plug-in  module  used  for  controlling  stepper 

motor  for  lateral  gripper  motion  (inserted 
into  axis  #  4  on -DCX  mother  board) 
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Data  Acquisition  Board 

Manufacturer:  Data  Translation,  Inc. 

100  Locke  Drive 
Marlboro,  MA  01752-1192 
(617)  481  3700 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number:  DT  2821 

Description:  8  channel  differential  or  16  channel  single- 

ended  12-bit  A/D  converters,  2  12-bit  D/A 
converters  and  16  I/O  lines 


Electronic  Hardware 
stepper  Motor  and  Driver 

Manufacturer:  Oriental  Motor  U.S.A.,  Corp. 

Head  Office: 

2701  Plaza  Del  Amo,  Suite  702 
Torrance,  CA  90503 
(213)  515  2264 

Vendor:  EMCO,  Inc. 

P.O.  Box  5618 
Greenville,  S.C.  29606 
(803)  232  7616 

Part  Number:  UMD  245-AA 

Description:  SUPER  VEXTA  Mini  UMD  Step  Motor/Driver  package 

Servo  Motor  System 

Manufacturer:  Maxon  Precision  Motors,  Inc. 

838  Mitten  Road,  Burlingame,  CA  94010 
(415)  697  9614 

Vendor:  Acquired  directly  from  manufacturer 

(a)  Part  Number:  RE035-071-34EAB  00  A 
Description:  40  W  DC  Motor 

(b)  Part  Number:  2932.702  —  0035.0  -  000 
Description:  35:1  Planetary  Gearhead 

(c)  Part  Number:  mmc  -  QR  030  024-02  LD  OOA 
Description:  50  W  Linear  Servo  Amplifier 


Encoder 
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Manufacturer:  Hewlett-Packard,  U.S.A. 

P.O.  Box  10301,  Pala  Alto 
CA  94303-0890 

Vendor:  Motor,  Gearhead  and  Encoder  were  acquired  from  Maxon 
Precision  Motors,  Inc.  as  a  single  package 

Part  Number:  HP  HEDS  5010 

Desription:  500  Line  Digital  Encoder 

Pneumatic  Valves 

Manufacturer:  Clippard  Instrument  Laboratory,  Inc. 

7390  Colerain  Road,  Cincinnati,  OH  45239 
(513)  521  4261 

Vendor:  Barker  Air  &  Hydraulics,  Inc. 

211  Eisenhower  Drive 
Greenville,  SC  29606 
(803)  271  4910 

Part  Number:  EMC-12-24-40 

Description:  Electronic  Manifold  Card  with  12  3 -way  pneumatic 
valves  operating  on  24  V 


Mechanical  Hardware 


Grippers 

Manufacturer:  Compact  Air  Products,  Inc. 

P.O.  Box  499 

Westminster,  SC  29693-0499 
(803)  647  9521 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number:  PSG052xl/4  (2  off) 

Description:  Two  jaw  parallel  gripper 
Gripper  Jaw  Liners 

Manufacturer:  Stock  Drive  Products,  Inc. 

2101  Jericho  Turnpike 
New  Hyde  Park,  NY  11040 
(516)  328  3330 

Vendor:  Acquired  directly  from  manufacturer 
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Part  Number:  D68S87MGU2 
Description;  Rubber  Jaw  Liner 
Gears 

Manufacturer:  Winfred  M.  Berg,  Inc. 

499  Ocean  Avenue 
East  Rockaway,  NY  11518 
(516)  599  5010 

Vendor:  Acquired  directly  from  manufacturer 
Part  Number;  P32A28-36  (2  off) 

Desription:  1.125"  36  teeth  20  degrees  pressure  angle 

Aluminum  gears 

Timing  Belt  System 

Manufacturer:  Winfred  M.  Berg,  Inc. 

499  Ocean  Avenue 
East  Rockaway,  NY  11518 
(516)  599  5010 

Vendor;  Acquired  directly  from  manufacturer 

(a)  Pitch  Motion  System 

Part  Number (s) :  20TP4-14  (pulley),  20TP4-42  (pulley),  20TB- 

75  (belt) 

(b)  Lateral  Gripper  Motion  System 

Part  Number (s) :  20TP4-14  (pulley),  20TP4-28  (pulley),  20TB- 

95  (belt) 

Description;  1/5"  Pitch  (XL)  0.200"  Circular  Pitch  Belt 
System 

Ball  Bearings 

Manufacturer:  Fafnir  Bearing  Division  of  The  Torrington 

Company, 

New  Britain,  CT  06050 

Vendor:  Dixie  Bearings,  Inc. 

215  McGee  Road 
Anderson,  SC  29621 
(803)  225  3791 


(a)  Pitch  Bearings 
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Part  Number;  S7PP  (2  off) 

Description;  Extra  small  radial  bearings  5/8*'  bore 
(b)  Ball  Screw  Supports 
Part  Number;  S1PP7  (4  off) 

Description;  Extra  small  radial  bearings  1/4"  bore 
Linear  Bearings 

Manufacturer;  Thomson  Industries,  Inc. 

Port  Washington,  NY  11050 
(516)  883  8000 

Vendor;  Dixie  Bearings,  Inc. 

215  McGee  Road 
Anderson,  SC  29621 
(803)  225  3791 

Part  Number;  SUPER-4  (4  off) 

Description;  Super  ball  bushing  bearings 
Part  Number;  60  Case  Shaft  Class  'L*  1/4"  Diameter 
Description;  2  7.25"  (length)  linear  bearing  shafts 
Ball  Screws 

Manufacturer;  Saginaw  Steering  Gear  Division 
General  Motors  Corporation 

Vendor;  Dixie  Bearings,  Inc. 

215  McGee  Road 

Anderson,  SC  29621  (803)  225  3791 

Part  Number;  0375  -  0125  (B2)  5707502  (2  off) 

Description;  0.375"  nominal  diameter,  0.125"  pitch  right-hand 
ball  nut 

Part  Number;  0375  -  0125  5669420  (2  ft.) 

Description;  0.375"  nominal  diameter,  0.125"  pitch  right-hand 
ball  screw 
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This  appendix  shows  the  electrical  wiring  for  the  servo 


motor,  stepper  motor  and  pneiomatic  gripper  systems. 
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Figure  D.l.  Servo  Motor  Drive  Circuit 


147 


Stepper  Motor  Drive  Circuit 
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L 


Figure  D.3.  Pneumatic  Valve  Drive  Circuit 
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Appendix  E 
Program  Listing 

This  appendix  includes  listings  of  programs  RESP.C  and 
ATOD.C  which  record  the  experimental  performance  of  the  end- 
effector  pitch  and  lateral  gripper  motions  respectively. 

The  following  sequence  of  operations  need  to  be  carried 
out  to  obtain  the  simulated  and  experimental  response  curves 
of  the  pitch  motion. 

1.  Manually  position  the  end-effector  so  that  it  is  at  60 
degrees  in  the  direction  shown  in  Figure  A. 2. 

2.  Ensure  that  the  power  supply  to  the  servo  amplifier  is 
set  at  15  V. 

3.  Execute  RESP.EXE  after  compiling  and  linking  RESP.C. 

4.  Input  the  desired  gain  value. (in  COUNTS/COUNT)  and  the 
desired  angular  pitch  displacement  in  DEGREES.  Ensure 
that  the  angular  displacement  does  not  exceed  the  physi¬ 
cal  limits  of  the  motion  (+90  degrees  to  -  60  degrees 
from  the  horizontal  position) . 

5.  After  execution  of  RESP.EXE,  go  into  the  MATLAB  environ¬ 
ment  and  execute  TIMERESP. 

6.  To  obtain  a  hard  copy  of  the  response  curves,  use  the 
MATLAB  meta  file,  RESPONSE . MET . 
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/*  RESP.C  */ 

/*  A  program  to  compare  the  simulated  and  experimental  re¬ 
sponses  of  the  end-effector  pitch  motion  */ 

# include  <dos.h> 

# include  <stdlib.h> 

# include  <stdio.h> 

# include  <hand.h>  /*  includes  routines  to  issue  commands 

and  receive  status  information  from 
the  DCX  board  */ 

# include  <math.h> 

void  init_hand() ; 

long  mv,  ma,  skp,  kd,  ki,  lim; 

float  kp; 

long  max_vel,  max_acc; 

main() 

{ 


struct  rpyfmt32  pos[4]; 

FILE  *out; 
long  y[2000]; 
long  enc_counts; 
int  i ,  j ; 

float  degrees,  ref [2],  tref[2]; 
double  angle,  z,  inst[2000]; 

/*  open  a  file  of  MATLAB  commands  */ 


out  =  fopenC 
fprintf (out, 
fprintf (out, 
fprintf (out, 
fprintf (out, 
init_hand() ; 


timeresp.txt",  "w") ; 

"clear\n") ; 

'• !  del  c :  \\tr .  out\n'' )  ; 

'• !  del  c :  \\matlab\\response .  met\n'' )  ; 

"diary  c;\\tr.out\n") ; 

/*  sets  velocity,  acceleration  and  gain 
parameters  */ 


j  =  0; 

inst [ 0 ]  =  0.0; 
z  =  0.0; 
y[0]  =  O; 

printfC'How  many  degrees  do  you  want  to  move?\n”)  ; 
printf("A  positive  number  pitches  the  end-effector  such 
that\n") ; 

printfC'the  end-effector  gripper  points  towards  the 
floor\n") ; 

scanf("%f",  fidegrees) ; 

/*  The  desired  pitch  displacement  must  be  converted  from 
DEGREES  to  COUNTS  */ 
enc_counts  =  (long)  (583.33333*degrees) ; 

dcxcmd(0,  1,  AXIS3  +  MR,  enc_counts) ;  /*  moves  the  end- 

effector  by  the  desired  number  of  counts  */ 
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/*  the  pitch  displacement  is  continuosly  read  and  writ 
ten  into  an  array  */ 
for  (  i  =  1;  i  <  2000;  i++) 

{ 

dcxcmd(0,  1,  TP,  OL) ; 

dcxrpy(0,  sizeof(pos),  (int  far  *)pos) ; 
y[i]  =  pos[2].val; 

) 

i  =  1; 

fprintf(out,  "d  =  [\n'')  ; 
fprintf(out,  ''%lf\n'',  60.0); 
while  (z  <  500.0) 

^  if  (abs(y[i]  -  y[i  -  1])  ==  0) 

{ 

z  =  z  +  2.82 ; 

} 

else 

^  angle  =  60.0  +  0. 0017142857* (double) (labs (y[i] 

-y[0]));  /*  converts  COUNTS  to  DEGREES 

*/ 

fprintf(out,  '•%lf\n'',  angle); 
z  =  z  +  2.82;  /*  it  takes  2.82  milliseconds 

to  obtain  the  encoder  count 
from  the  DCX  board  */ 

j++; 

inst[j]  =  z/1000.0; 

} 

i++; 

fprintf(out,  "%lf\n",  60.0  +  0.0017142857*(double) (labs(y[i] 
-  y[0]))) ; 

f print f ( out ,  " ] ; \n" ) ; 
fprintf(out,  "z  =  [\n'')  ; 
for  (i  =  0;  i  <=  j;  i++) 

^  fprintf(out,  "%lf\n'‘,  inst[i]); 

} 

fprintf(out,  "%lf\n'',  0.5); 
f printf ( out ,  " ] ; \n" ) ; 

/*  reference  input  */ 

ref[0]  =  60.0  +  fabs (degrees) ; 
ref[l]  *  60.0  +  fabs (degrees) ; 
tref[0]  =  0:0; 
tref[l]  =  500.0; 

fprintf(out,  "tref  =  [\n") ; 
for  (i=0;  i<2;  i  ++) 

^  fprintf(out,  ''%lf\n",  ( (double)  tref[i]  )/1000.0)  ; 
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} 

fprintf(out,  "];\n"); 
fprintf(out,  "ref  =  [\n") ; 
for  (i  =  0;  i  <  2;  i  ++) 

^  fprintf(out,  "%lf\n",  (doxible) ref  [i] )  ; 

} 

f printf ( out ,  " ] ; \n" ) ; 

/*  SIMULATION  TIME  RESPONSE  */ 

/*  the  theoretical  transfer  function  is  computed  based  on 
the  input  gain  and  the  desired  displacement;  the 
simulated  step  response  of  the  transfer  function  is 
computed  using  the  STEP  conmand  of  MATLAB  */ 

fprintf(out,  "pgain  =  %f;\n",  kp) ; 
fprintf(out,  "degrees  =  %f;\n",  fabs (degrees) ) ; 
fprintf(out,  "n  =  ll99.87*pgain*degrees;\n") ; 
fprintf(out,  "niim  =  [n];\n"); 

fprintf(out,  "wn2  =  18.07  +  1198.701*pgain;\n") ; 
fprintf(out,  "den  =  [1  70.54  wn2];\n"); 
fprintf(out,  "s  =  0;0.005:0.5;\n"); 
fprintf(out,  "t  =  s\‘;\n"); 
fprintf (out,  "r  =  step\(num,den, t\) ;\n") ; 
fprintf(out,  "u  =  60.0  +  r;\n'')  ; 


/*  plot  options  */ 


} 


fprintf (out, 

fprintf (out, 
fprintf (out, 
fprintf (out, 
fprintf (out, 
fprintf (out, 
fprintf (out, 
fclose(out) ; 


"plot\(2,d,\*-\' ,t,u,\'— \' rtref ,  ref 
\'\)\n»); 

"title\(\'KP  =  %2.2f  \')\n'',  kp)  ; 

"xlabel\ ( • SECONDS ' \) \n" ) ; 

"ylabel\ ( ' DEGREES • \) \n" ) ; 

"grid\n") ; 

"meta  response\n") ; 

"diary  off\n") ; 


void  init_hand()  /*  Servo  Motor  Initialization  -  axis  #  3  */ 


/*  the  velocity  and  acceleration  are  set  to  very  high 
values  to  approximate  the  trapezoidal  velocity  profile  gener¬ 
ated  by  the  DCX  board  as  a  step  position  input  */ 

max_vel  =  20000000; 
max_acc  =  2000000; 

dcxcmd(0,  2,  AXIS 3  +  SV,  max_vel,  AXIS 3  +  SA,  max_acc) ; 
printf ("Enter  Kp  -  Proportional  Gain\n") ; 
scanf("%f",  &kp) ; 
skp  =  (long) (kp*16.0) ; 


153 


/*  the  desired  gain  value  is  multiplied  by  a  factor  of  16  to 
compensate  for  division  by  16  by  the  DCX  board  prior  to 
outputting  the  count  to  the  D/A  converter  */ 

dcxcmd(0,  1,  AXIS3  +  SG,  skp) ; 

/*  The  derivative  and  integral  gains  are  set  to  zero  */ 
kd  =  0; 

dcxcmd(0,  1,  AXIS3  +  SD,  kd) ; 
ki  =  0; 

dcxcmd(0,  1,  AXIS3  +  SI,  ki) ; 
lim  =0; 

dcxcmd(0,  1,  AXIS3  +  IL,  lim); 

dcxcmd(0,  2,  AXIS3  +  MN,  01,  AXIS3  +  DH,  OL) ; 


/*  End  of  RESP.C  */ 
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The  following  steps  must  be  executed  in  sequence  to  obtain 

the  experimental  response  of  the  translating  motion  of  the 

grippers . 

1  Connect  the  moving  part  of  a  linear  potentiometer  to  one 
of  the  ball  nuts  that  translate  the  grippers.  Ensure 
that  the  axis  of  the  potentiometer  is  parallel  to  the 
axis  of  motion. 

2.  Connect  the  electrical  contact  of  the  moving  part  of  the 
potentiometer  to  the  positive  terminal  of  Channel  0  of 
the  Data  Translation  DT  2821  board. 

3.  ^  +/-  10  V  supply  must  be  applied  to  the  potentiometer. 

4.  Compile,  link  and  execute  ATOD.C.  Select  a  gain  of  1 
and  ensure  that  the  commanded  motion  does  not  exceed  the 
limits  of  the  end-effector. 

5.  Enter  the  MATLAB  environment  and  execute  ATOD  to  observe 
the  response. 

6.  To  obtain  a  hard  copy  of  the  response  curve,  use  the 
MATLAB  meta  file,  POTRESP.MET. 
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/*  atod.c  */ 

/*  A  program  to  measure  the  performance  of  the  lateral  grip¬ 
per  motion  of  the  end-effector  */ 

# include  <dos.h> 

# include  <stdlib.h> 

# include  <stdio.h> 

# include  <time.h> 

#include  <conio.h>  /*  Console  I/O  header  file.  */ 

# include  <atldefs.h>  /*  ATLAB  function  definition  file.  */ 
iinclude  <atlerrs.h>  /*  ATLAB  error  definition  file.  */ 

# include  <hand.h> 

# include  <math.h> 

# include  <atod.h> 

#define  TRUE  1 
Idefine  FALSE  0 

FILE  *out; 

int  channels [ 16 ] ;  /*  channel  scan  list  */ 
int  gains[16];  /*  gains  for  channels  */ 
long  i,  num  =  11849; 
int  pot_read [ 15000 ] ; 

double  inches,  inst  [5000],  t  =  0.0; 
double  distance; 
int  j,  sine  =  0; 

long  init_vel,  final_vel,  acc,  steps; 

struct  dostime__t  tml,  tm2; 
double  diff; 

AL_CONFIGURATION  configuration;  /*  storage  for  unit  config 
data  */ 

double  elap_time(); 

main  () 

{ 

char  input [10]; 
int  max_channel; 
unsigned  value; 

/*  This  portion  of  the  code  adapted  from  Data  Translation's 
example  program  */ 

AL_INITIALIZE  ( ) 7 

/*  Select  board  1,  the  first  unit.  */ 

AL_SELECT_BOARD  (  1  ) ; 

/*  Perform  a  reset  on  the  device.  */ 
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AL_RESET  ( )  ; 

/*  Display  the  current  unit  configuration.  */ 

/*  Get  the  unit  configuration  for  the  number  of  A/D  channels. 
*/ 

AL_GET_CONFIGURATION  (  & configuration  ) ; 
max  channel  =  conf iguration.channel_count  -  1; 


Request  channel  and  gain.  Note  the  use  of  unit  configu¬ 
ration  data  to  determine  the  max  channel  number  and  the  need 
for  gain  values. 

*/ 

/*  Get  the  channel  number,  considering  how  many  we  have.*/ 

printf ("Enter  desired  channel  [0-%2d]:  ",  max_channel  ); 

scanf (  "%d%*c",  &channels[0]  ); 

/*  Get  the  gain  if  the  unit  has  programmable  gain.*/ 
if  (  conf igurat ion. device_id  & 

(  DT2821  I  DT2821_F_DI  |  DT2821_F_SE  |  DT2821_G_DI  j 
DT2821_G_SE  |  DT2824_PGH  )  )  { 
printf ("Enter  desired  gain  [1,2,4  or  8]:  ") ; 

scanf (  "%d%*c",  SgainstO]  ); 

else  if  (  conf  igurat  ion.  device_id  &  (  DT2825  j  DT2824_PGL  )  ) 

printf ("Enter  desired  gain  [1,10,100  or  500];  ") ; 

scanf (  "%d%*c",  Stgains[0]  ); 

} 

else 

gains [0]  =1; 

/*  End  of  Data  Translation's  Code  */ 


printf ("Input  Initial  Velocity\n") ; 
scanf ("%ld",  &init_vel) ; 
printf ("Input  Final  Velocity\n") ; 
scanf ("%ld",  &final_vel) ; 
printf ("Input  Acceleration\n") ; 
scanf ("%ld",  &acc) ; 

dcxcmd(0,  3,  AXIS4  +  SI,  init_vel,  AXIS4  +  SV,  final_vel, 

AXIS4  +  SA,  acc)  ,- 

dcxcmd(0,  1,  AXIS4  +  MN,  01); 

printf ("Input  distance  in  inches  that  you  need  to  move\n") ; 
printf ("  CAUTION  !!!  \n") ; 
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printf("  Input  a  positive  niimber  \(0  to  3.125\)  to  move  the 

grippers  together  \n")  ;  .  » 

printfC  Input  a  negative  n\imber  \(0  to  -  3.125\)  to  move 

grippers  apart \n'')  ;  4.  •  i. 

printfC  Otherwise  you  may  cause  damage  to  the  potentiometer 

!\n”) ; 

scanfC%lf",  fidistance)  ;  _ 

steps  =  (long)  (distance  *  8.0  *  400.0);  /*  inches  x  no.  of 
steps  per  revolution  of  ball  screw  /  pitch  of  ball  screw  */ 
dcxcmd(0,  1,  AXIS4  +  MR,  steps) ; 

dos  gettime(&tml) ;  /*  To  determine  the  abcissa  values  of 

the  plot  */ 

for  (  i  =  0;  i  <  num;  i++) 

^  AL_ADC_VALUE  (  channels [0],  gains [0],  &value  ); 
pot_read[i]  =  value; 

AL_DAC_VALUE  (  0 ,  fivalue  ) ; 

} 

_dos_gettime (&tm2) ; 

diff  =  elap_time(&tml,  &tm2) ; 

dcxcmd(0,  2,  AXIS4  +  WS,  1001,  AXIS4  +  MF,  01); 

printfC'It  took  %f  seconds  to  execute  %ld  A/D  conversions\ 

n”,  diff,  nxim)  ; 

printf(”At  a  rate  of  %f  seconds  per  conversion\n” ,  diff/ 

(double) num) ; 

/*  Terminate  ATLAB  operations.*/ 

AL_TERMINATE  ( ) ; 

/*  open  a  file  of  MATLAB  commands  */ 

out  =  fopenCatod.txt'*,  '‘w*)  ; 
fprintf(out,  "clear\n") ; 
fprintf(out,  "!del  c;\\pot.out\n"); 
fprintf(out,  "Idel  c;\\matlab\\potresp.met\n"); 
fprintf(out,  "diary  c:\\pot. out \n'')  ; 

inst[0]  =  0.0; 
fprintf(out,  "y  *  [\n") ; 
fprintf(out,  "%lf\n",  0.00); 
for  (i  =  1;  i  <  num;  i++) 

^  if  (abs(pot_read[i]  -  pot_read[i  -  1])  <=  1) 

{ 

} 

else 


t  =  t  +  0.000422; 
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sine  =  abs(pot_read[i]  -  pot_read [ 0 ] ) ; 
inches  =  (doxible) sine  *  0.001953125; 
fprintf(out,  ••%lf\n",  inches); 
t  =  t  +  0.000422; 

j++; 

inst[j]  =  t; 

) 

} 

fprintf(out,  •'%lf\n",  inches); 
f printf  (out ,  "  ] ; \n'' )  ; 
fprintf(out,  "t  *=  [\n")  ; 
for  (i  =  0;  i  <=  j;  i++) 

^  fprintf(out,  "%lf\n”,  inst[i]); 

) 

fprintf(out,  ”%lf\n",  4.0); 
fprintf(out,  ''];\n'')/ 

/*  MATLAB  Plot  Options  */ 

fprintf(out,  '•plot\(t,y, \'“\'\) \n'')  ;  .  .  ' 

fprintf(out,  ''title\(\*IV  =  %ld  FV  =  %ld  ”,  init_vel, 

final  vel) ;  ^  , 

fprintf(out,  "ACC  =  %ld  REF  =  %6. 31f\' \) \n" ,  acc,  fabs 
(distance) ) ; 

f printf (out,  ”xlabel\( 'SECONDS ’X) \n") ; 
fprintf(out,  "ylabel\( 'LINEAR  MOTION  in'\)\n"); 
fprintf(out,  "grid\n") ; 
fprintf(out,  "meta  potresp\n”) ; 
fprintf(out,  "diary  off \n") ; 
f close (out) ; 

} 

double  elap_time(tml,  tni2)  /*  Determines  the  elapsed  time 

between  two  instants  */ 

struct  dostime_t  *tml,  *tm2; 

{ 

doxible  diff,  tsecl,  tsec2; 

tsecl  =  ( (double) ( (*tml) .hour) ) *3600. 0  + 

( (double) ( (*tml) .minute) ) *60. 0  + 

( (double) ( (*tml) .second) )  + 

( (double) ( (*tml) .hsecond) )/100.0; 
tsec2  =  ( (double) ( (*tm2) .hour) ) *3600. 0  + 

( (double) ( (*tm2) .minute) ) *60.0  + 

( (double) ( (*tm2) .second) )  + 

( (double) ( (*tm2) .hsecond) )/100.0; 
diff  =  tsec2  -  tsecl; 
if (diff  <  0.0) 

diff  =  diff  +  86400.0; 

} 


/*  End  of  ATOD.C  */ 
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